Example of 6D orientation recognition for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of 6DOrientation_IKS01A2 by ST Expansion SW Team

6D Orientation Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to use sensor expansion board to find out the 6D orientation and send data using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can rotate the board to change the 6D orientation and then view the data using an hyper terminal.
- the user button can be used to display the current 6D orientation.

Committer:
cparata
Date:
Fri Aug 19 15:09:06 2016 +0000
Revision:
3:be6b73a04943
Parent:
2:ae74845fa96a
Fix issue in magnetometer class

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 2:ae74845fa96a 1 /**
cparata 2:ae74845fa96a 2 ******************************************************************************
cparata 2:ae74845fa96a 3 * @file LSM303AGR_MAG_Sensor.h
cparata 2:ae74845fa96a 4 * @author AST
cparata 2:ae74845fa96a 5 * @version V1.0.0
cparata 2:ae74845fa96a 6 * @date 5 August 2016
cparata 2:ae74845fa96a 7 * @brief Abstract Class of an LSM303AGR magnetometer sensor.
cparata 2:ae74845fa96a 8 ******************************************************************************
cparata 2:ae74845fa96a 9 * @attention
cparata 2:ae74845fa96a 10 *
cparata 2:ae74845fa96a 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 2:ae74845fa96a 12 *
cparata 2:ae74845fa96a 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 2:ae74845fa96a 14 * are permitted provided that the following conditions are met:
cparata 2:ae74845fa96a 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 2:ae74845fa96a 16 * this list of conditions and the following disclaimer.
cparata 2:ae74845fa96a 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 2:ae74845fa96a 18 * this list of conditions and the following disclaimer in the documentation
cparata 2:ae74845fa96a 19 * and/or other materials provided with the distribution.
cparata 2:ae74845fa96a 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 2:ae74845fa96a 21 * may be used to endorse or promote products derived from this software
cparata 2:ae74845fa96a 22 * without specific prior written permission.
cparata 2:ae74845fa96a 23 *
cparata 2:ae74845fa96a 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 2:ae74845fa96a 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 2:ae74845fa96a 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 2:ae74845fa96a 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 2:ae74845fa96a 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 2:ae74845fa96a 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 2:ae74845fa96a 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 2:ae74845fa96a 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 2:ae74845fa96a 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 2:ae74845fa96a 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 2:ae74845fa96a 34 *
cparata 2:ae74845fa96a 35 ******************************************************************************
cparata 2:ae74845fa96a 36 */
cparata 2:ae74845fa96a 37
cparata 2:ae74845fa96a 38
cparata 2:ae74845fa96a 39 /* Prevent recursive inclusion -----------------------------------------------*/
cparata 2:ae74845fa96a 40
cparata 2:ae74845fa96a 41 #ifndef __LSM303AGR_MAG_Sensor_H__
cparata 2:ae74845fa96a 42 #define __LSM303AGR_MAG_Sensor_H__
cparata 2:ae74845fa96a 43
cparata 2:ae74845fa96a 44
cparata 2:ae74845fa96a 45 /* Includes ------------------------------------------------------------------*/
cparata 2:ae74845fa96a 46
cparata 2:ae74845fa96a 47 #include "DevI2C.h"
cparata 2:ae74845fa96a 48 #include "LSM303AGR_MAG_driver.h"
cparata 2:ae74845fa96a 49 #include "MagneticSensor.h"
cparata 2:ae74845fa96a 50
cparata 2:ae74845fa96a 51
cparata 2:ae74845fa96a 52 /* Class Declaration ---------------------------------------------------------*/
cparata 2:ae74845fa96a 53
cparata 2:ae74845fa96a 54 /**
cparata 2:ae74845fa96a 55 * Abstract class of an LSM303AGR Inertial Measurement Unit (IMU) 6 axes
cparata 2:ae74845fa96a 56 * sensor.
cparata 2:ae74845fa96a 57 */
cparata 3:be6b73a04943 58 class LSM303AGR_MAG_Sensor : public MagneticSensor
cparata 2:ae74845fa96a 59 {
cparata 2:ae74845fa96a 60 public:
cparata 2:ae74845fa96a 61 LSM303AGR_MAG_Sensor(DevI2C &i2c);
cparata 2:ae74845fa96a 62 LSM303AGR_MAG_Sensor(DevI2C &i2c, uint8_t address);
cparata 2:ae74845fa96a 63 virtual int Init(void *init);
cparata 2:ae74845fa96a 64 virtual int ReadID(uint8_t *id);
cparata 2:ae74845fa96a 65 virtual int Get_M_Axes(int32_t *pData);
cparata 2:ae74845fa96a 66 virtual int Get_M_AxesRaw(int16_t *pData);
cparata 2:ae74845fa96a 67 int Enable(void);
cparata 2:ae74845fa96a 68 int Disable(void);
cparata 2:ae74845fa96a 69 int Get_M_Sensitivity(float *pfData);
cparata 2:ae74845fa96a 70 int Get_M_ODR(float *odr);
cparata 2:ae74845fa96a 71 int Set_M_ODR(float odr);
cparata 2:ae74845fa96a 72 int Get_M_FS(float *fullScale);
cparata 2:ae74845fa96a 73 int Set_M_FS(float fullScale);
cparata 2:ae74845fa96a 74 int ReadReg(uint8_t reg, uint8_t *data);
cparata 2:ae74845fa96a 75 int WriteReg(uint8_t reg, uint8_t data);
cparata 2:ae74845fa96a 76
cparata 2:ae74845fa96a 77 /**
cparata 2:ae74845fa96a 78 * @brief Utility function to read data.
cparata 2:ae74845fa96a 79 * @param pBuffer: pointer to data to be read.
cparata 2:ae74845fa96a 80 * @param RegisterAddr: specifies internal address register to be read.
cparata 2:ae74845fa96a 81 * @param NumByteToRead: number of bytes to be read.
cparata 2:ae74845fa96a 82 * @retval 0 if ok, an error code otherwise.
cparata 2:ae74845fa96a 83 */
cparata 2:ae74845fa96a 84 uint8_t IO_Read(uint8_t* pBuffer, uint8_t RegisterAddr, uint16_t NumByteToRead)
cparata 2:ae74845fa96a 85 {
cparata 2:ae74845fa96a 86 return (uint8_t) dev_i2c.i2c_read(pBuffer, address, RegisterAddr, NumByteToRead);
cparata 2:ae74845fa96a 87 }
cparata 2:ae74845fa96a 88
cparata 2:ae74845fa96a 89 /**
cparata 2:ae74845fa96a 90 * @brief Utility function to write data.
cparata 2:ae74845fa96a 91 * @param pBuffer: pointer to data to be written.
cparata 2:ae74845fa96a 92 * @param RegisterAddr: specifies internal address register to be written.
cparata 2:ae74845fa96a 93 * @param NumByteToWrite: number of bytes to write.
cparata 2:ae74845fa96a 94 * @retval 0 if ok, an error code otherwise.
cparata 2:ae74845fa96a 95 */
cparata 2:ae74845fa96a 96 uint8_t IO_Write(uint8_t* pBuffer, uint8_t RegisterAddr, uint16_t NumByteToWrite)
cparata 2:ae74845fa96a 97 {
cparata 2:ae74845fa96a 98 return (uint8_t) dev_i2c.i2c_write(pBuffer, address, RegisterAddr, NumByteToWrite);
cparata 2:ae74845fa96a 99 }
cparata 2:ae74845fa96a 100
cparata 2:ae74845fa96a 101 private:
cparata 2:ae74845fa96a 102
cparata 2:ae74845fa96a 103 /* Helper classes. */
cparata 2:ae74845fa96a 104 DevI2C &dev_i2c;
cparata 2:ae74845fa96a 105
cparata 2:ae74845fa96a 106 /* Configuration */
cparata 2:ae74845fa96a 107 uint8_t address;
cparata 2:ae74845fa96a 108 };
cparata 2:ae74845fa96a 109
cparata 2:ae74845fa96a 110 #ifdef __cplusplus
cparata 2:ae74845fa96a 111 extern "C" {
cparata 2:ae74845fa96a 112 #endif
cparata 2:ae74845fa96a 113 uint8_t LSM303AGR_MAG_IO_Write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite );
cparata 2:ae74845fa96a 114 uint8_t LSM303AGR_MAG_IO_Read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead );
cparata 2:ae74845fa96a 115 #ifdef __cplusplus
cparata 2:ae74845fa96a 116 }
cparata 2:ae74845fa96a 117 #endif
cparata 2:ae74845fa96a 118
cparata 2:ae74845fa96a 119 #endif