BNO055 library using Bosch's code
Diff: BNO055.cpp
- Revision:
- 0:1f82672b8755
diff -r 000000000000 -r 1f82672b8755 BNO055.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/BNO055.cpp Sat Jul 01 01:24:03 2017 +0000 @@ -0,0 +1,17642 @@ +/* +* +**************************************************************************** +* Copyright (C) 2015 - 2016 Bosch Sensortec GmbH +* +* File : bno055.c +* +* Date : 2016/03/14 +* +* Revision : 2.0.3 $ +* +* Usage: Sensor Driver file for BNO055 sensor +* +**************************************************************************** +* \section License +* +* Redistribution and use in source and binary forms, with or without +* modification, are permitted provided that the following conditions are met: +* +* Redistributions of source code must retain the above copyright +* notice, this list of conditions and the following disclaimer. +* +* Redistributions in binary form must reproduce the above copyright +* notice, this list of conditions and the following disclaimer in the +* documentation and/or other materials provided with the distribution. +* +* Neither the name of the copyright holder nor the names of the +* contributors may be used to endorse or promote products derived from +* this software without specific prior written permission. +* +* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND +* CONTRIBUTORS "AS IS" AND ANY EXPRESS OR +* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED +* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE +* DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDER +* OR CONTRIBUTORS BE LIABLE FOR ANY +* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, +* OR CONSEQUENTIAL DAMAGES(INCLUDING, BUT NOT LIMITED TO, +* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; +* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, +* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT +* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN +* ANY WAY OUT OF THE USE OF THIS +* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE +* +* The information provided is believed to be accurate and reliable. +* The copyright holder assumes no responsibility +* for the consequences of use +* of such information nor for any infringement of patents or +* other rights of third parties which may result from its use. +* No license is granted by implication or otherwise under any patent or +* patent rights of the copyright holder. +**************************************************************************/ + +/*********************************************************/ +/* INCLUDES */ +/*******************************************************/ +#include "BNO055.h" +/*! file <BNO055 > + brief <Sensor driver for BNO055> */ +/* STRUCTURE DEFINITIONS */ +/*static*/ struct bno055_t *p_bno055; + +/* LOCAL FUNCTIONS */ +/*! + * @brief + * This API is used for initialize + * bus read, bus write function pointers,device + * address,accel revision id, gyro revision id + * mag revision id, software revision id, boot loader + * revision id and page id + * + * @param bno055 - structure pointer + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While changing the parameter of the bno055_t + * consider the following point: + * Changing the reference value of the parameter + * will changes the local copy or local reference + * make sure your changes will not + * affect the reference value of the parameter + * (Better case don't change the reference value of the parameter) + */ +BNO055_RETURN_FUNCTION_TYPE bno055_init(struct bno055_t *bno055) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + u8 bno055_page_zero_u8 = BNO055_PAGE_ZERO; + /* Array holding the Software revision id + */ + u8 a_SW_ID_u8[BNO055_REV_ID_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* stuct parameters are assign to bno055*/ + p_bno055 = bno055; + /* Write the default page as zero*/ + com_rslt = p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_PAGE_ID_REG, &bno055_page_zero_u8, BNO055_GEN_READ_WRITE_LENGTH); + /* Read the chip id of the sensor from page + zero 0x00 register*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_CHIP_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->chip_id = data_u8; + /* Read the accel revision id from page + zero 0x01 register*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_REV_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->accel_rev_id = data_u8; + /* Read the mag revision id from page + zero 0x02 register*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_REV_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->mag_rev_id = data_u8; + /* Read the gyro revision id from page + zero 0x02 register*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_REV_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->gyro_rev_id = data_u8; + /* Read the boot loader revision from page + zero 0x06 register*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_BL_REV_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->bl_rev_id = data_u8; + /* Read the software revision id from page + zero 0x04 and 0x05 register( 2 bytes of data)*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC(p_bno055->dev_addr, + BNO055_SW_REV_ID_LSB_REG, + a_SW_ID_u8, BNO055_LSB_MSB_READ_LENGTH); + a_SW_ID_u8[BNO055_SW_ID_LSB] = BNO055_GET_BITSLICE( + a_SW_ID_u8[BNO055_SW_ID_LSB], + BNO055_SW_REV_ID_LSB); + p_bno055->sw_rev_id = (u16) + ((((u32)((u8)a_SW_ID_u8[BNO055_SW_ID_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | (a_SW_ID_u8[BNO055_SW_ID_LSB])); + /* Read the page id from the register 0x07*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_PAGE_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + p_bno055->page_id = data_u8; + + return com_rslt; +} +/*! + * @brief + * This API gives data to the given register and + * the data is written in the corresponding register address + * + * @param addr_u8 : Address of the register + * @param data_u8 : Data to be written to the register + * @param len_u8 : Length of the Data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * +*/ +BNO055_RETURN_FUNCTION_TYPE bno055_write_register(u8 addr_u8, +u8 *data_u8, u8 len_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* Write the values of respective given register */ + com_rslt = p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, addr_u8, data_u8, len_u8); + } + return com_rslt; +} +/*! + * @brief This API reads the data from + * the given register address + * + * @param addr_u8 : Address of the register + * @param data_u8 : address of the variable, + * read value will be kept + * @param len_u8 : Length of the data + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_register(u8 addr_u8, +u8 *data_u8, u8 len_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* Read the value from given register*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, addr_u8, data_u8, len_u8); + } + return com_rslt; +} +/*! + * @brief This API reads chip id + * from register 0x00 it is a byte of data + * + * + * @param chip_id_u8 : The chip id value 0xA0 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_chip_id(u8 *chip_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the chip id*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_CHIP_ID_REG, &data_u8, + BNO055_GEN_READ_WRITE_LENGTH); + *chip_id_u8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads software revision id + * from register 0x04 and 0x05 it is a two byte of data + * + * @param sw_id_u8 : The SW revision id + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_sw_rev_id(u16 *sw_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* array having the software revision id + data_u8[0] - LSB + data_u8[1] - MSB*/ + u8 data_u8[BNO055_REV_ID_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty*/ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value of software + revision id*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SW_REV_ID_LSB_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SW_ID_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SW_ID_LSB], + BNO055_SW_REV_ID_LSB); + *sw_id_u8 = (u16) + ((((u32)((u8)data_u8[BNO055_SW_ID_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SW_ID_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads page id + * from register 0x07 it is a byte of data + * + * + * @param page_id_u8 : The value of page id + * + * BNO055_PAGE_ZERO -> 0x00 + * BNO055_PAGE_ONE -> 0x01 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_page_id(u8 *page_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* Read the page id form 0x07*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_PAGE_ID_REG, &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8 = BNO055_GET_BITSLICE(data_u8, + BNO055_PAGE_ID); + *page_id_u8 = data_u8; + p_bno055->page_id = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write + * the page id register 0x07 + * + * @param page_id_u8 : The value of page id + * + * BNO055_PAGE_ZERO -> 0x00 + * BNO055_PAGE_ONE -> 0x01 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_write_page_id(u8 page_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* Read the current page*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_PAGE_ID_REG, &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + /* Check condition for communication BNO055_SUCCESS*/ + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE(data_u8r, + BNO055_PAGE_ID, page_id_u8); + /* Write the page id*/ + com_rslt += p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_PAGE_ID_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) + p_bno055->page_id = page_id_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads accel revision id + * from register 0x01 it is a byte of value + * + * @param accel_rev_id_u8 : The accel revision id 0xFB + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_rev_id( +u8 *accel_rev_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel revision id */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_REV_ID_REG, + &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + *accel_rev_id_u8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads mag revision id + * from register 0x02 it is a byte of value + * + * @param mag_rev_id_u8 : The mag revision id 0x32 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_rev_id( +u8 *mag_rev_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the mag revision id */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_REV_ID_REG, + &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + *mag_rev_id_u8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro revision id + * from register 0x03 it is a byte of value + * + * @param gyro_rev_id_u8 : The gyro revision id 0xF0 + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_rev_id( +u8 *gyro_rev_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro revision id */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_REV_ID_REG, + &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_rev_id_u8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read boot loader revision id + * from register 0x06 it is a byte of value + * + * @param bl_rev_id_u8 : The boot loader revision id + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_bl_rev_id( +u8 *bl_rev_id_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the boot loader revision id */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_BL_REV_ID_REG, + &data_u8, BNO055_GEN_READ_WRITE_LENGTH); + *bl_rev_id_u8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads acceleration data X values + * from register 0x08 and 0x09 it is a two byte data + * + * + * + * + * @param accel_x_s16 : The X raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_x(s16 *accel_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the accel x value + data_u8[BNO055_SENSOR_DATA_LSB] - x-LSB + data_u8[BNO055_SENSOR_DATA_MSB] - x-MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel x axis two byte value*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_ACCEL_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_ACCEL_DATA_X_MSB_VALUEX); + *accel_x_s16 = (s16)((((s32) + (s8)(data_u8[BNO055_SENSOR_DATA_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads acceleration data Y values + * from register 0x0A and 0x0B it is a two byte data + * + * + * + * + * @param accel_y_s16 : The Y raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_y(s16 *accel_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the accel y value + data_u8[BNO055_SENSOR_DATA_LSB] - y-LSB + data_u8[BNO055_SENSOR_DATA_MSB] - y-MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel y axis two byte value*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_ACCEL_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_ACCEL_DATA_Y_MSB_VALUEY); + *accel_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads acceleration data z values + * from register 0x0C and 0x0D it is a two byte data + * + * + * + * + * @param accel_z_s16 : The z raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_z(s16 *accel_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the accel z value + data_u8[BNO055_SENSOR_DATA_LSB] - z-LSB + data_u8[BNO055_SENSOR_DATA_MSB] - z-MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel z axis two byte value*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_ACCEL_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_ACCEL_DATA_Z_MSB_VALUEZ); + *accel_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads acceleration data xyz values + * from register 0x08 to 0x0D it is a six byte data + * + * + * @param accel : The value of accel xyz data + * + * Parameter | result + * --------- | ----------------- + * x | The accel x data + * y | The accel y data + * z | The accel z data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_xyz( +struct bno055_accel_t *accel) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the accel xyz value + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_ACCEL_XYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_ACCEL_XYZ_DATA_SIZE); + /* Data X*/ + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB], + BNO055_ACCEL_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB], + BNO055_ACCEL_DATA_X_MSB_VALUEX); + accel->x = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB])); + /* Data Y*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB], + BNO055_ACCEL_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB], + BNO055_ACCEL_DATA_Y_MSB_VALUEY); + accel->y = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB])); + /* Data Z*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB], + BNO055_ACCEL_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB], + BNO055_ACCEL_DATA_Z_MSB_VALUEZ); + accel->z = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads mag data x values + * from register 0x0E and 0x0F it is a two byte data + * + * + * + * + * @param mag_x_s16 : The x raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_x(s16 *mag_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the mag x value + data_u8[BNO055_SENSOR_DATA_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - x->MSB + */ + u8 data_u8[BNO055_MAG_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /*Read the mag x two bytes of data */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_MAG_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_MAG_DATA_X_MSB_VALUEX); + *mag_x_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | ( + data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads mag data y values + * from register 0x10 and 0x11 it is a two byte data + * + * + * + * + * @param mag_y_s16 : The y raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_y(s16 *mag_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the mag y value + data_u8[BNO055_SENSOR_DATA_LSB] - y->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - y->MSB + */ + u8 data_u8[BNO055_MAG_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /*Read the mag y two bytes of data */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_MAG_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_MAG_DATA_Y_MSB_VALUEY); + *mag_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads mag data z values + * from register 0x12 and 0x13 it is a two byte data + * + * + * + * + * @param mag_z_s16 : The z raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_z(s16 *mag_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the mag z value + data_u8[BNO055_SENSOR_DATA_LSB] - z->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - z->MSB + */ + u8 data_u8[BNO055_MAG_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + /*Read the mag z two bytes of data */ + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_MAG_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_MAG_DATA_Z_MSB_VALUEZ); + *mag_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads mag data xyz values + * from register 0x0E to 0x13 it is a six byte data + * + * + * @param mag : The mag xyz values + * + * Parameter | result + * --------- | ----------------- + * x | The mag x data + * y | The mag y data + * z | The mag z data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_xyz(struct bno055_mag_t *mag) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the mag xyz value + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_MAG_XYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /*Read the six byte value of mag xyz*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_MAG_XYZ_DATA_SIZE); + /* Data X*/ + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB], + BNO055_MAG_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB], + BNO055_MAG_DATA_X_MSB_VALUEX); + mag->x = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB])); + /* Data Y*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB], + BNO055_MAG_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB], + BNO055_MAG_DATA_Y_MSB_VALUEY); + mag->y = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB])); + /* Data Z*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB], + BNO055_MAG_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB], + BNO055_MAG_DATA_Z_MSB_VALUEZ); + mag->z = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro data x values + * from register 0x14 and 0x15 it is a two byte data + * + * + * + * + * @param gyro_x_s16 : The x raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_x(s16 *gyro_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8[BNO055_GYRO_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro 16 bit x value*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GYRO_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GYRO_DATA_X_MSB_VALUEX); + *gyro_x_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro data y values + * from register 0x16 and 0x17 it is a two byte data + * + * + * + * + * @param gyro_y_s16 : The y raw data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_y(s16 *gyro_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8[BNO055_GYRO_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of gyro y */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GYRO_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GYRO_DATA_Y_MSB_VALUEY); + *gyro_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro data z values + * from register 0x18 and 0x19 it is a two byte data + * + * @param gyro_z_s16 : The z raw data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_z(s16 *gyro_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8[BNO055_GYRO_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro z 16 bit value*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GYRO_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GYRO_DATA_Z_MSB_VALUEZ); + *gyro_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro data xyz values + * from register 0x14 to 0x19 it is a six byte data + * + * + * @param gyro : The value of gyro xyz data's + * + * Parameter | result + * --------- | ----------------- + * x | The gyro x data + * y | The gyro y data + * z | The gyro z data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_xyz(struct bno055_gyro_t *gyro) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gyro xyz value + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_GYRO_XYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the six bytes data of gyro xyz*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_GYRO_XYZ_DATA_SIZE); + /* Data x*/ + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB], + BNO055_GYRO_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB], + BNO055_GYRO_DATA_X_MSB_VALUEX); + gyro->x = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB])); + /* Data y*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB], + BNO055_GYRO_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB], + BNO055_GYRO_DATA_Y_MSB_VALUEY); + gyro->y = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB])); + /* Data z*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB], + BNO055_GYRO_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB], + BNO055_GYRO_DATA_Z_MSB_VALUEZ); + gyro->z = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gyro data z values + * from register 0x1A and 0x1B it is a two byte data + * + * @param euler_h_s16 : The raw h data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_euler_h(s16 *euler_h_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the Euler h value + data_u8[BNO055_SENSOR_DATA_EULER_LSB] - h->LSB + data_u8[BNO055_SENSOR_DATA_EULER_MSB] - h->MSB + */ + u8 data_u8[BNO055_EULER_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the eulre heading data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_H_LSB_VALUEH_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_EULER_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_LSB], + BNO055_EULER_H_LSB_VALUEH); + data_u8[BNO055_SENSOR_DATA_EULER_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_MSB], + BNO055_EULER_H_MSB_VALUEH); + *euler_h_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_EULER_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Euler data r values + * from register 0x1C and 0x1D it is a two byte data + * + * @param euler_r_s16 : The raw r data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_euler_r(s16 *euler_r_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the Euler r value + data_u8[BNO055_SENSOR_DATA_EULER_LSB] - r->LSB + data_u8[BNO055_SENSOR_DATA_EULER_MSB] - r->MSB + */ + u8 data_u8[BNO055_EULER_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the Euler roll data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_R_LSB_VALUER_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_EULER_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_LSB], + BNO055_EULER_R_LSB_VALUER); + data_u8[BNO055_SENSOR_DATA_EULER_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_MSB], + BNO055_EULER_R_MSB_VALUER); + *euler_r_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_EULER_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Euler data p values + * from register 0x1E and 0x1F it is a two byte data + * + * @param euler_p_s16 : The raw p data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_euler_p(s16 *euler_p_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the Euler p value + data_u8[BNO055_SENSOR_DATA_EULER_LSB] - p->LSB + data_u8[BNO055_SENSOR_DATA_EULER_MSB] - p->MSB + */ + u8 data_u8[BNO055_EULER_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the Euler p data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_P_LSB_VALUEP_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_EULER_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_LSB], + BNO055_EULER_P_LSB_VALUEP); + data_u8[BNO055_SENSOR_DATA_EULER_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_MSB], + BNO055_EULER_P_MSB_VALUEP); + *euler_p_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_EULER_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Euler data hrp values + * from register 0x1A to 0x1F it is a six byte data + * + * + * @param euler : The Euler hrp data's + * + * Parameter | result + * --------- | ----------------- + * h | The Euler h data + * r | The Euler r data + * p | The Euler p data + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_euler_hrp( +struct bno055_euler_t *euler) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the Euler hrp value + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_LSB] - h->LSB + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_MSB] - h->MSB + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_LSB] - r->MSB + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_MSB] - r->MSB + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_LSB] - p->MSB + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_MSB] - p->MSB + */ + u8 data_u8[BNO055_EULER_HRP_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the six byte of Euler hrp data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_H_LSB_VALUEH_REG, + data_u8, BNO055_EULER_HRP_DATA_SIZE); + /* Data h*/ + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_LSB], + BNO055_EULER_H_LSB_VALUEH); + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_MSB], + BNO055_EULER_H_MSB_VALUEH); + euler->h = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_EULER_HRP_H_LSB])); + /* Data r*/ + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_LSB], + BNO055_EULER_R_LSB_VALUER); + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_MSB], + BNO055_EULER_R_MSB_VALUER); + euler->r = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_EULER_HRP_R_LSB])); + /* Data p*/ + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_LSB], + BNO055_EULER_P_LSB_VALUEP); + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_MSB], + BNO055_EULER_P_MSB_VALUEP); + euler->p = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_EULER_HRP_P_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads quaternion data w values + * from register 0x20 and 0x21 it is a two byte data + * + * @param quaternion_w_s16 : The raw w data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_quaternion_w( +s16 *quaternion_w_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the Quaternion w value + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] - w->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] - w->MSB + */ + u8 data_u8[BNO055_QUATERNION_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of quaternion w data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_QUATERNION_DATA_W_LSB_VALUEW_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB], + BNO055_QUATERNION_DATA_W_LSB_VALUEW); + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB], + BNO055_QUATERNION_DATA_W_MSB_VALUEW); + *quaternion_w_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads quaternion data x values + * from register 0x22 and 0x23 it is a two byte data + * + * @param quaternion_x_s16 : The raw x data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_quaternion_x( +s16 *quaternion_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the quaternion x value + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] - x->MSB + */ + u8 data_u8[BNO055_QUATERNION_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of quaternion x data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_QUATERNION_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB], + BNO055_QUATERNION_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB], + BNO055_QUATERNION_DATA_X_MSB_VALUEX); + *quaternion_x_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads quaternion data y values + * from register 0x24 and 0x25 it is a two byte data + * + * @param quaternion_y_s16 : The raw y data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_quaternion_y( +s16 *quaternion_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the quaternion y value + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] - y->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] - y->MSB + */ + u8 data_u8[BNO055_QUATERNION_DATA_SIZE] = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of quaternion y data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_QUATERNION_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB], + BNO055_QUATERNION_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] = + BNO055_GET_BITSLICE + (data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB], + BNO055_QUATERNION_DATA_Y_MSB_VALUEY); + *quaternion_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads quaternion data z values + * from register 0x26 and 0x27 it is a two byte data + * + * @param quaternion_z_s16 : The raw z data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_quaternion_z( +s16 *quaternion_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the quaternion z value + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] - z->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] - z->MSB + */ + u8 data_u8[BNO055_QUATERNION_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of quaternion z data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_QUATERNION_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB], + BNO055_QUATERNION_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB], + BNO055_QUATERNION_DATA_Z_MSB_VALUEZ); + *quaternion_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_QUATERNION_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_QUATERNION_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Quaternion data wxyz values + * from register 0x20 to 0x27 it is a six byte data + * + * + * @param quaternion : The value of quaternion wxyz data's + * + * Parameter | result + * --------- | ----------------- + * w | The quaternion w data + * x | The quaternion x data + * y | The quaternion y data + * z | The quaternion z data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_quaternion_wxyz( +struct bno055_quaternion_t *quaternion) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the quaternion wxyz value + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_LSB] - w->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_MSB] - w->MSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_QUATERNION_WXYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the eight byte value + of quaternion wxyz data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_QUATERNION_DATA_W_LSB_VALUEW_REG, + data_u8, BNO055_QUATERNION_WXYZ_DATA_SIZE); + /* Data W*/ + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_LSB], + BNO055_QUATERNION_DATA_W_LSB_VALUEW); + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_MSB], + BNO055_QUATERNION_DATA_W_MSB_VALUEW); + quaternion->w = (s16)((((s32)((s8) + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_W_LSB])); + /* Data X*/ + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_LSB], + BNO055_QUATERNION_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_MSB], + BNO055_QUATERNION_DATA_X_MSB_VALUEX); + quaternion->x = (s16)((((s32)((s8) + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_X_LSB])); + /* Data Y*/ + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_LSB], + BNO055_QUATERNION_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_MSB], + BNO055_QUATERNION_DATA_Y_MSB_VALUEY); + quaternion->y = (s16)((((s32)((s8) + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Y_LSB])); + /* Data Z*/ + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_LSB], + BNO055_QUATERNION_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_MSB], + BNO055_QUATERNION_DATA_Z_MSB_VALUEZ); + quaternion->z = (s16)((((s32)((s8) + data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_QUATERNION_WXYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Linear accel data x values + * from register 0x29 and 0x2A it is a two byte data + * + * @param linear_accel_x_s16 : The raw x data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_linear_accel_x( +s16 *linear_accel_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the linear accel x value + data_u8[BNO055_SENSOR_DATA_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - x->MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of linear accel x data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_LINEAR_ACCEL_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_LINEAR_ACCEL_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_LINEAR_ACCEL_DATA_X_MSB_VALUEX); + *linear_accel_x_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Linear accel data x values + * from register 0x2B and 0x2C it is a two byte data + * + * @param linear_accel_y_s16 : The raw y data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_linear_accel_y( +s16 *linear_accel_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the linear accel y value + data_u8[BNO055_SENSOR_DATA_LSB] - y->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - y->MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of linear accel y data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_LINEAR_ACCEL_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_LINEAR_ACCEL_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_LINEAR_ACCEL_DATA_Y_MSB_VALUEY); + *linear_accel_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | ( + data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Linear accel data x values + * from register 0x2C and 0x2D it is a two byte data + * + * @param linear_accel_z_s16 : The raw z data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_linear_accel_z( +s16 *linear_accel_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the linear accel z value + data_u8[BNO055_SENSOR_DATA_LSB] - z->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - z->MSB + */ + u8 data_u8[BNO055_ACCEL_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of linear accel z data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_LINEAR_ACCEL_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_LINEAR_ACCEL_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_LINEAR_ACCEL_DATA_Z_MSB_VALUEZ); + *linear_accel_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | ( + data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads Linear accel data xyz values + * from register 0x28 to 0x2D it is a six byte data + * + * + * @param linear_accel : The value of linear accel xyz data's + * + * Parameter | result + * --------- | ----------------- + * x | The linear accel x data + * y | The linear accel y data + * z | The linear accel z data + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_linear_accel_xyz( +struct bno055_linear_accel_t *linear_accel) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the linear accel xyz value + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_ACCEL_XYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the six byte value + of linear accel xyz data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_LINEAR_ACCEL_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_ACCEL_XYZ_DATA_SIZE); + /* Data x*/ + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB], + BNO055_LINEAR_ACCEL_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB], + BNO055_LINEAR_ACCEL_DATA_X_MSB_VALUEX); + linear_accel->x = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB])); + /* Data y*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB], + BNO055_LINEAR_ACCEL_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB], + BNO055_LINEAR_ACCEL_DATA_Y_MSB_VALUEY); + linear_accel->y = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB])); + /* Data z*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB], + BNO055_LINEAR_ACCEL_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB], + BNO055_LINEAR_ACCEL_DATA_Z_MSB_VALUEZ); + linear_accel->z = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gravity data x values + * from register 0x2E and 0x2F it is a two byte data + * + * @param gravity_x_s16 : The raw x data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gravity_x( +s16 *gravity_x_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gravity x value + data_u8[BNO055_SENSOR_DATA_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - x->MSB + */ + u8 data_u8[BNO055_GRAVITY_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of gravity x data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GRAVITY_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GRAVITY_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GRAVITY_DATA_X_MSB_VALUEX); + *gravity_x_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gravity data y values + * from register 0x30 and 0x31 it is a two byte data + * + * @param gravity_y_s16 : The raw y data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gravity_y( +s16 *gravity_y_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gravity y value + data_u8[BNO055_SENSOR_DATA_LSB] - y->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - y->MSB + */ + u8 data_u8[BNO055_GRAVITY_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of gravity y data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GRAVITY_DATA_Y_LSB_VALUEY_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GRAVITY_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GRAVITY_DATA_Y_MSB_VALUEY); + *gravity_y_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gravity data z values + * from register 0x32 and 0x33 it is a two byte data + * + * @param gravity_z_s16 : The raw z data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gravity_z( +s16 *gravity_z_s16) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gravity z value + data_u8[BNO055_SENSOR_DATA_LSB] - z->LSB + data_u8[BNO055_SENSOR_DATA_MSB] - z->MSB + */ + u8 data_u8[BNO055_GRAVITY_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the two byte value + of gravity z data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GRAVITY_DATA_Z_LSB_VALUEZ_REG, + data_u8, BNO055_LSB_MSB_READ_LENGTH); + data_u8[BNO055_SENSOR_DATA_LSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_LSB], + BNO055_GRAVITY_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_MSB] = + BNO055_GET_BITSLICE(data_u8[BNO055_SENSOR_DATA_MSB], + BNO055_GRAVITY_DATA_Z_MSB_VALUEZ); + *gravity_z_s16 = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads gravity data xyz values + * from register 0x2E to 0x33 it is a six byte data + * + * + * @param gravity : The value of gravity xyz data's + * + * Parameter | result + * --------- | ----------------- + * x | The gravity x data + * y | The gravity y data + * z | The gravity z data + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gravity_xyz( +struct bno055_gravity_t *gravity) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gravity xyz value + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] - x->LSB + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] - x->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] - y->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] - z->MSB + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] - z->MSB + */ + u8 data_u8[BNO055_GRAVITY_XYZ_DATA_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the six byte value + of gravity xyz data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GRAVITY_DATA_X_LSB_VALUEX_REG, + data_u8, BNO055_GRAVITY_XYZ_DATA_SIZE); + /* Data x*/ + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB], + BNO055_GRAVITY_DATA_X_LSB_VALUEX); + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB], + BNO055_GRAVITY_DATA_X_MSB_VALUEX); + gravity->x = (s16)(((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_X_MSB]) << + BNO055_SHIFT_EIGHT_BITS) | + (data_u8[BNO055_SENSOR_DATA_XYZ_X_LSB])); + /* Data y*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB], + BNO055_GRAVITY_DATA_Y_LSB_VALUEY); + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB], + BNO055_GRAVITY_DATA_Y_MSB_VALUEY); + gravity->y = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Y_MSB])) << + BNO055_SHIFT_EIGHT_BITS) | ( + data_u8[BNO055_SENSOR_DATA_XYZ_Y_LSB])); + /* Data z*/ + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB], + BNO055_GRAVITY_DATA_Z_LSB_VALUEZ); + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB], + BNO055_GRAVITY_DATA_Z_MSB_VALUEZ); + gravity->z = (s16)((((s32) + ((s8)data_u8[BNO055_SENSOR_DATA_XYZ_Z_MSB])) << + BNO055_SHIFT_EIGHT_BITS) + | (data_u8[BNO055_SENSOR_DATA_XYZ_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API reads temperature values + * from register 0x33 it is a byte data + * + * @param temp_s8 : The raw temperature data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_temp_data(s8 *temp_s8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8 = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the raw temperature data */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_REG, &data_u8, + BNO055_GEN_READ_WRITE_LENGTH); + *temp_s8 = data_u8; + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +#ifdef BNO055_FLOAT_ENABLE +/*! + * @brief This API is used to convert the accel x raw data + * to meterpersecseq output as float + * + * @param accel_x_f : The accel x meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_x_msq( +float *accel_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw x data*/ + com_rslt += bno055_read_accel_x(®_accel_x_s16); + p_bno055->delay_msec(BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel x to m/s2*/ + data_f = + (float)(reg_accel_x_s16/BNO055_ACCEL_DIV_MSQ); + *accel_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel x raw data + * to millig output as float + * + * @param accel_x_f : The accel x millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_x_mg( +float *accel_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw x data*/ + com_rslt += bno055_read_accel_x(®_accel_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel x to m/s2*/ + data_f = + (float)(reg_accel_x_s16/BNO055_ACCEL_DIV_MG); + *accel_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel x raw data + * to meterpersecseq output as float + * + * @param accel_y_f : The accel y meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_y_msq( +float *accel_y_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_y_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + com_rslt += bno055_read_accel_y(®_accel_y_s16); + p_bno055->delay_msec(BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel y to m/s2*/ + data_f = + (float)(reg_accel_y_s16/BNO055_ACCEL_DIV_MSQ); + *accel_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel y raw data + * to millig output as float + * + * @param accel_y_f : The accel y millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_y_mg( +float *accel_y_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_y_s16 = BNO055_INIT_VALUE; + float data = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw z data*/ + com_rslt += bno055_read_accel_y(®_accel_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel z to mg*/ + data = (float)( + reg_accel_y_s16/BNO055_ACCEL_DIV_MG); + *accel_y_f = data; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel z raw data + * to meterpersecseq output as float + * + * @param accel_z_f : The accel z meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_z_msq( +float *accel_z_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw z data*/ + com_rslt += bno055_read_accel_z(®_accel_z_s16); + p_bno055->delay_msec(BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel z to m/s2*/ + data_f = + (float)(reg_accel_z_s16/BNO055_ACCEL_DIV_MSQ); + *accel_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel z raw data + * to millig output as float + * + * @param accel_z_f : The accel z millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_z_mg( +float *accel_z_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2 */ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw z data*/ + com_rslt += bno055_read_accel_z(®_accel_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw accel x to mg*/ + data_f = + (float)(reg_accel_z_s16/BNO055_ACCEL_DIV_MG); + *accel_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel xyz raw data + * to meterpersecseq output as float + * + * @param accel_xyz : The meterpersecseq data of accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of accel + * y | meterpersecseq data of accel + * z | meterpersecseq data of accel + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_xyz_msq( +struct bno055_accel_float_t *accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_accel_t reg_accel_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw xyz data*/ + com_rslt += bno055_read_accel_xyz(®_accel_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the accel raw xyz to meterpersecseq*/ + accel_xyz->x = + (float)(reg_accel_xyz.x/BNO055_ACCEL_DIV_MSQ); + accel_xyz->y = + (float)(reg_accel_xyz.y/BNO055_ACCEL_DIV_MSQ); + accel_xyz->z = + (float)(reg_accel_xyz.z/BNO055_ACCEL_DIV_MSQ); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel xyz raw data + * to millig output as float + * + * @param accel_xyz : The millig data of accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | millig data of accel + * y | millig data of accel + * z | millig data of accel + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_accel_xyz_mg( +struct bno055_accel_float_t *accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_accel_t reg_accel_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw y data*/ + com_rslt += bno055_read_accel_xyz(®_accel_xyz); + if (com_rslt == BNO055_SUCCESS) { + /*Convert the accel raw xyz to millig */ + accel_xyz->x = + (float)(reg_accel_xyz.x/BNO055_ACCEL_DIV_MG); + accel_xyz->y = + (float)(reg_accel_xyz.y/BNO055_ACCEL_DIV_MG); + accel_xyz->z = + (float)(reg_accel_xyz.z/BNO055_ACCEL_DIV_MG); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag x raw data + * to microTesla output as float + * + * @param mag_x_f : The mag x microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_mag_x_uT( +float *mag_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw mag x data */ + com_rslt = bno055_read_mag_x(®_mag_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw mag x to microTesla*/ + data_f = (float)(reg_mag_x_s16/BNO055_MAG_DIV_UT); + *mag_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag y raw data + * to microTesla output as float + * + * @param mag_y_f : The mag y microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_mag_y_uT( +float *mag_y_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_y_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw mag y data */ + com_rslt = bno055_read_mag_y(®_mag_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw mag y to microTesla*/ + data_f = (float)(reg_mag_y_s16/BNO055_MAG_DIV_UT); + *mag_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag z raw data + * to microTesla output as float + * + * @param mag_z_f : The mag z microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_mag_z_uT( +float *mag_z_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw mag z data */ + com_rslt = bno055_read_mag_z(®_mag_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw mag z to microTesla*/ + data_f = (float)(reg_mag_z_s16/BNO055_MAG_DIV_UT); + *mag_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag yz raw data + * to microTesla output as float + * + * @param mag_xyz_data : The microTesla data of mag xyz + * + * Parameter | result + * --------- | ----------------- + * x | microTesla data of mag + * y | microTesla data of mag + * z | microTesla data of mag + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_mag_xyz_uT( +struct bno055_mag_float_t *mag_xyz_data) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_mag_t mag_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read raw mag x data */ + com_rslt = bno055_read_mag_xyz(&mag_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert mag raw xyz to microTesla*/ + mag_xyz_data->x = (float)(mag_xyz.x/BNO055_MAG_DIV_UT); + mag_xyz_data->y = (float)(mag_xyz.y/BNO055_MAG_DIV_UT); + mag_xyz_data->z = (float)(mag_xyz.z/BNO055_MAG_DIV_UT); + } else { + com_rslt = BNO055_ERROR; + } + + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro x raw data + * to dps output as float + * + * @param gyro_x_f : The gyro x dps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_x_dps( +float *gyro_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_x(®_gyro_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to dps*/ + data_f = + (float)(reg_gyro_x_s16/BNO055_GYRO_DIV_DPS); + *gyro_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro x raw data + * to rps output as float + * + * @param gyro_x_f : The gyro x dps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_x_rps( +float *gyro_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_x(®_gyro_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to rps*/ + data_f = + (float)(reg_gyro_x_s16/BNO055_GYRO_DIV_RPS); + *gyro_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro y raw data + * to dps output as float + * + * @param gyro_y_f : The gyro y dps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_y_dps( +float *gyro_y_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_y_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw y data */ + com_rslt += bno055_read_gyro_y(®_gyro_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to dps*/ + data_f = + (float)(reg_gyro_y_s16/BNO055_GYRO_DIV_DPS); + *gyro_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro y raw data + * to rps output as float + * + * @param gyro_y_f : The gyro y dps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_y_rps( +float *gyro_y_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_y_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw y data */ + com_rslt += bno055_read_gyro_y(®_gyro_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to rps*/ + data_f = + (float)(reg_gyro_y_s16/BNO055_GYRO_DIV_RPS); + *gyro_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro z raw data + * to dps output as float + * + * @param gyro_z_f : The gyro z dps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_z_dps( +float *gyro_z_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw z data */ + com_rslt += bno055_read_gyro_z(®_gyro_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to dps*/ + data_f = + (float)(reg_gyro_z_s16/BNO055_GYRO_DIV_DPS); + *gyro_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro z raw data + * to rps output as float + * + * @param gyro_z_f : The gyro z rps float data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_z_rps( +float *gyro_z_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_z(®_gyro_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro x to rps*/ + data_f = + (float)(reg_gyro_z_s16/BNO055_GYRO_DIV_RPS); + *gyro_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro xyz raw data + * to dps output as float + * + * @param gyro_xyz_data : The dps data of gyro xyz + * + * Parameter | result + * --------- | ----------------- + * x | dps data of gyro + * y | dps data of gyro + * z | dps data of gyro + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_xyz_dps( +struct bno055_gyro_float_t *gyro_xyz_data) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gyro_t gyro_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw xyz data */ + com_rslt += bno055_read_gyro_xyz(&gyro_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert gyro raw xyz to dps*/ + gyro_xyz_data->x = + (float)(gyro_xyz.x/BNO055_GYRO_DIV_DPS); + gyro_xyz_data->y = + (float)(gyro_xyz.y/BNO055_GYRO_DIV_DPS); + gyro_xyz_data->z = + (float)(gyro_xyz.z/BNO055_GYRO_DIV_DPS); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro xyz raw data + * to rps output as float + * + * @param gyro_xyz_data : The rps data of gyro xyz + * + * Parameter | result + * --------- | ----------------- + * x | rps data of gyro + * y | rps data of gyro + * z | rps data of gyro + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gyro_xyz_rps( +struct bno055_gyro_float_t *gyro_xyz_data) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gyro_t gyro_xyz = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw xyz data */ + com_rslt += bno055_read_gyro_xyz(&gyro_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert gyro raw xyz to rps*/ + gyro_xyz_data->x = + (float)(gyro_xyz.x/BNO055_GYRO_DIV_RPS); + gyro_xyz_data->y = + (float)(gyro_xyz.y/BNO055_GYRO_DIV_RPS); + gyro_xyz_data->z = + (float)(gyro_xyz.z/BNO055_GYRO_DIV_RPS); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler h raw data + * to degree output as float + * + * @param euler_h_f : The float value of Euler h degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_h_deg( +float *euler_h_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_h_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw h data*/ + com_rslt += bno055_read_euler_h(®_euler_h_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler h data to degree*/ + data_f = + (float)(reg_euler_h_s16/BNO055_EULER_DIV_DEG); + *euler_h_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler h raw data + * to radians output as float + * + * @param euler_h_f : The float value of Euler h radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_h_rad( +float *euler_h_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_h_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw h data*/ + com_rslt += bno055_read_euler_h(®_euler_h_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler h data to degree*/ + data_f = + (float)(reg_euler_h_s16/BNO055_EULER_DIV_RAD); + *euler_h_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler r raw data + * to degree output as float + * + * @param euler_r_f : The float value of Euler r degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_r_deg( +float *euler_r_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_r = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw r data*/ + com_rslt += bno055_read_euler_r(®_euler_r); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler r data to degree*/ + data_f = (float)( + reg_euler_r/BNO055_EULER_DIV_DEG); + *euler_r_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler r raw data + * to radians output as float + * + * @param euler_r_f : The float value of Euler r radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_r_rad( +float *euler_r_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_r_f = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw r data*/ + com_rslt += bno055_read_euler_r(®_euler_r_f); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler r data to radians*/ + data_f = + (float)(reg_euler_r_f/BNO055_EULER_DIV_RAD); + *euler_r_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler p raw data + * to degree output as float + * + * @param euler_p_f : The float value of Euler p degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_p_deg( +float *euler_p_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_p_f = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw p data*/ + com_rslt += bno055_read_euler_p(®_euler_p_f); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler p data to degree*/ + data_f = + (float)(reg_euler_p_f/BNO055_EULER_DIV_DEG); + *euler_p_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler p raw data + * to radians output as float + * + * @param euler_p_f : The float value of Euler p radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_p_rad( +float *euler_p_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_p_f = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw r data*/ + com_rslt += bno055_read_euler_p(®_euler_p_f); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler r data to radians*/ + data_f = + (float)(reg_euler_p_f/BNO055_EULER_DIV_RAD); + *euler_p_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler hrp raw data + * to degree output as float + * + * @param euler_hpr : The degree data of Euler hrp + * + * Parameter | result + * --------- | ----------------- + * h | degree data of Euler + * r | degree data of Euler + * p | degree data of Euler + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_hpr_deg( +struct bno055_euler_float_t *euler_hpr) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_euler_t reg_euler = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw hrp data*/ + com_rslt += bno055_read_euler_hrp(®_euler); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler hrp to degree*/ + euler_hpr->h = + (float)(reg_euler.h/BNO055_EULER_DIV_DEG); + euler_hpr->p = + (float)(reg_euler.p/BNO055_EULER_DIV_DEG); + euler_hpr->r = + (float)(reg_euler.r/BNO055_EULER_DIV_DEG); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler xyz raw data + * to radians output as float + * + * @param euler_hpr : The radians data of Euler hrp + * + * Parameter | result + * --------- | ----------------- + * h | radians data of Euler + * r | radians data of Euler + * p | radians data of Euler + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_euler_hpr_rad( +struct bno055_euler_float_t *euler_hpr) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_euler_t reg_euler = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw hrp data*/ + com_rslt += bno055_read_euler_hrp(®_euler); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw hrp to radians */ + euler_hpr->h = + (float)(reg_euler.h/BNO055_EULER_DIV_RAD); + euler_hpr->p = + (float)(reg_euler.p/BNO055_EULER_DIV_RAD); + euler_hpr->r = + (float)(reg_euler.r/BNO055_EULER_DIV_RAD); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel x raw data to meterpersecseq output as float + * + * @param linear_accel_x_f : The float value of linear accel x meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_linear_accel_x_msq( +float *linear_accel_x_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_x(®_linear_accel_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw linear accel x to m/s2*/ + data_f = + (float)(reg_linear_accel_x_s16/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel y raw data to meterpersecseq output as float + * + * @param linear_accel_y_f : The float value of linear accel y meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_linear_accel_y_msq( +float *linear_accel_y_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_y = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read the raw y of linear accel */ + com_rslt = bno055_read_linear_accel_y(®_linear_accel_y); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw linear accel x to m/s2*/ + data_f = (float) + (reg_linear_accel_y/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel z raw data to meterpersecseq output as float + * + * @param linear_accel_z_f : The float value of linear accel z meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_linear_accel_z_msq( +float *linear_accel_z_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_z = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_z(®_linear_accel_z); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw linear accel z to m/s2*/ + data_f = (float) + (reg_linear_accel_z/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear accel xyz raw data + * to meterpersecseq output as float + * + * @param linear_accel_xyz : The meterpersecseq data of linear accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of linear accel + * y | meterpersecseq data of linear accel + * z | meterpersecseq data of linear accel + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_linear_accel_xyz_msq( +struct bno055_linear_accel_float_t *linear_accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_linear_accel_t reg_linear_accel = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_xyz(®_linear_accel); + if (com_rslt == BNO055_SUCCESS) { + linear_accel_xyz->x = + (float)(reg_linear_accel.x/BNO055_LINEAR_ACCEL_DIV_MSQ); + linear_accel_xyz->y = + (float)(reg_linear_accel.y/BNO055_LINEAR_ACCEL_DIV_MSQ); + linear_accel_xyz->z = + (float)(reg_linear_accel.z/BNO055_LINEAR_ACCEL_DIV_MSQ); + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * x raw data to meterpersecseq output as float + * + * @param gravity_x_f : The float value of gravity x meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_float_x_msq( +float *gravity_x_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_x_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw gravity of x*/ + com_rslt = bno055_read_gravity_x(®_gravity_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gravity x to m/s2*/ + data_f = (float)(reg_gravity_x_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_x_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * y raw data to meterpersecseq output as float + * + * @param gravity_y_f : The float value of gravity y meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_float_y_msq( +float *gravity_y_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_y_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw gravity of y*/ + com_rslt = bno055_read_gravity_y(®_gravity_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gravity y to m/s2*/ + data_f = (float)(reg_gravity_y_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_y_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * z raw data to meterpersecseq output as float + * + * @param gravity_z_f : The float value of gravity z meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_float_z_msq( +float *gravity_z_f) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_z_s16 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + /* Read raw gravity of z */ + com_rslt = bno055_read_gravity_z(®_gravity_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gravity z to m/s2*/ + data_f = (float)(reg_gravity_z_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_z_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity xyz raw data + * to meterpersecseq output as float + * + * @param gravity_xyz : The meterpersecseq data of gravity xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of gravity + * y | meterpersecseq data of gravity + * z | meterpersecseq data of gravity + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_gravity_xyz_msq( +struct bno055_gravity_float_t *gravity_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gravity_t reg_gravity_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read raw gravity of xyz */ + com_rslt = bno055_read_gravity_xyz(®_gravity_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gravity xyz to meterpersecseq */ + gravity_xyz->x = + (float)(reg_gravity_xyz.x/BNO055_GRAVITY_DIV_MSQ); + gravity_xyz->y = + (float)(reg_gravity_xyz.y/BNO055_GRAVITY_DIV_MSQ); + gravity_xyz->z = + (float)(reg_gravity_xyz.z/BNO055_GRAVITY_DIV_MSQ); + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the temperature + * data to Fahrenheit output as float + * + * @param temp_f : The float value of temperature Fahrenheit + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_temp_fahrenheit( +float *temp_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s8 reg_temp_s8 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 temp_unit_u8 = BNO055_INIT_VALUE; + /* Read the current temperature unit and set the + unit as Fahrenheit if the unit is in Celsius */ + com_rslt = bno055_get_temp_unit(&temp_unit_u8); + if (temp_unit_u8 != BNO055_TEMP_UNIT_FAHRENHEIT) + com_rslt += bno055_set_temp_unit(BNO055_TEMP_UNIT_FAHRENHEIT); + if (com_rslt == BNO055_SUCCESS) { + /* Read the raw temperature data */ + com_rslt += bno055_read_temp_data(®_temp_s8); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw temperature data to Fahrenheit*/ + data_f = (float) + (reg_temp_s8/BNO055_TEMP_DIV_FAHRENHEIT); + *temp_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the temperature + * data to Celsius output as float + * + * @param temp_f : The float value of temperature Celsius + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_float_temp_celsius( +float *temp_f) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s8 reg_temp_s8 = BNO055_INIT_VALUE; + float data_f = BNO055_INIT_VALUE; + u8 temp_unit_u8 = BNO055_INIT_VALUE; + /* Read the current temperature unit and set the + unit as Fahrenheit if the unit is in Celsius */ + com_rslt = bno055_get_temp_unit(&temp_unit_u8); + if (temp_unit_u8 != BNO055_TEMP_UNIT_CELSIUS) + com_rslt += bno055_set_temp_unit(BNO055_TEMP_UNIT_CELSIUS); + if (com_rslt == BNO055_SUCCESS) { + /* Read the raw temperature data */ + com_rslt += bno055_read_temp_data(®_temp_s8); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw temperature data to Fahrenheit*/ + data_f = + (float)(reg_temp_s8/BNO055_TEMP_DIV_CELSIUS); + *temp_f = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +#endif +#ifdef BNO055_DOUBLE_ENABLE +/*! + * @brief This API is used to convert the accel x raw data + * to meterpersecseq output as double + * + * @param accel_x_d : The accel x meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_x_msq( +double *accel_x_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_x_s16 = BNO055_INIT_VALUE; + double data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw y data*/ + com_rslt += bno055_read_accel_x(®_accel_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw x to m/s2 */ + data_f = + (double)(reg_accel_x_s16/BNO055_ACCEL_DIV_MSQ); + *accel_x_d = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel x raw data + * to millig output as double + * + * @param accel_x_d : The accel x millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_x_mg( +double *accel_x_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_x_s16 = BNO055_INIT_VALUE; + double data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw y data*/ + com_rslt += bno055_read_accel_x(®_accel_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw x to mg */ + data_f = + (double)(reg_accel_x_s16/BNO055_ACCEL_DIV_MG); + *accel_x_d = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel y raw data + * to meterpersecseq output as double + * + * @param accel_y_d : The accel y meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_y_msq( +double *accel_y_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_y_s16 = BNO055_INIT_VALUE; + double data_f = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw y data*/ + com_rslt += bno055_read_accel_y(®_accel_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw x to m/s2 */ + data_f = + (double)(reg_accel_y_s16/BNO055_ACCEL_DIV_MSQ); + *accel_y_d = data_f; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel y raw data + * to millig output as double + * + * @param accel_y_d : The accel y millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_y_mg( +double *accel_y_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw y data*/ + com_rslt += bno055_read_accel_y(®_accel_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw y to mg */ + data_d = + (double)(reg_accel_y_s16/BNO055_ACCEL_DIV_MG); + *accel_y_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel z raw data + * to meterpersecseq output as double + * + * @param accel_z_d : The accel z meterpersecseq data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_z_msq( +double *accel_z_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw z data*/ + com_rslt += bno055_read_accel_z(®_accel_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw z to m/s2 */ + data_d = + (double)(reg_accel_z_s16/BNO055_ACCEL_DIV_MSQ); + *accel_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel z raw data + * to millig output as double + * + * @param accel_z_d : The accel z millig data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_z_mg( +double *accel_z_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_accel_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as mg if the unit is in m/s2*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw z data*/ + com_rslt += bno055_read_accel_z(®_accel_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw z to mg */ + data_d = + (double)(reg_accel_z_s16/BNO055_ACCEL_DIV_MG); + *accel_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel xyz raw data + * to meterpersecseq output as double + * + * @param accel_xyz : The meterpersecseq data of accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of accel + * y | meterpersecseq data of accel + * z | meterpersecseq data of accel + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_xyz_msq( +struct bno055_accel_double_t *accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_accel_t reg_accel_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MSQ) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MSQ); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw xyz data*/ + com_rslt += bno055_read_accel_xyz(®_accel_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw xyz to m/s2*/ + accel_xyz->x = + (double)(reg_accel_xyz.x/BNO055_ACCEL_DIV_MSQ); + accel_xyz->y = + (double)(reg_accel_xyz.y/BNO055_ACCEL_DIV_MSQ); + accel_xyz->z = + (double)(reg_accel_xyz.z/BNO055_ACCEL_DIV_MSQ); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the accel xyz raw data + * to millig output as double + * + * @param accel_xyz : The millig data of accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | millig data of accel + * y | millig data of accel + * z | millig data of accel + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_accel_xyz_mg( +struct bno055_accel_double_t *accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_accel_t reg_accel_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 accel_unit_u8 = BNO055_INIT_VALUE; + /* Read the current accel unit and set the + unit as m/s2 if the unit is in mg*/ + com_rslt = bno055_get_accel_unit(&accel_unit_u8); + if (accel_unit_u8 != BNO055_ACCEL_UNIT_MG) + com_rslt += bno055_set_accel_unit(BNO055_ACCEL_UNIT_MG); + if (com_rslt == BNO055_SUCCESS) { + /* Read the accel raw xyz data*/ + com_rslt += bno055_read_accel_xyz(®_accel_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw xyz to mg*/ + accel_xyz->x = + (double)(reg_accel_xyz.x/BNO055_ACCEL_DIV_MG); + accel_xyz->y = + (double)(reg_accel_xyz.y/BNO055_ACCEL_DIV_MG); + accel_xyz->z = + (double)(reg_accel_xyz.z/BNO055_ACCEL_DIV_MG); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag x raw data + * to microTesla output as double + * + * @param mag_x_d : The mag x microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_mag_x_uT( +double *mag_x_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_x_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw mag x data */ + com_rslt = bno055_read_mag_x(®_mag_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw mag x to microTesla */ + data_d = (double)(reg_mag_x_s16/BNO055_MAG_DIV_UT); + *mag_x_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag y raw data + * to microTesla output as double + * + * @param mag_y_d : The mag y microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_mag_y_uT( +double *mag_y_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw mag y data */ + com_rslt = bno055_read_mag_y(®_mag_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw mag y to microTesla */ + data_d = (double)(reg_mag_y_s16/BNO055_MAG_DIV_UT); + *mag_y_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag z raw data + * to microTesla output as double + * + * @param mag_z_d : The mag z microTesla data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_mag_z_uT( +double *mag_z_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_mag_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw mag x */ + com_rslt = bno055_read_mag_z(®_mag_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw mag x to microTesla */ + data_d = (double)(reg_mag_z_s16/BNO055_MAG_DIV_UT); + *mag_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the mag yz raw data + * to microTesla output as double + * + * @param mag_xyz : The microTesla data of mag xyz + * + * Parameter | result + * --------- | ----------------- + * x | microTesla data of mag + * y | microTesla data of mag + * z | microTesla data of mag + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_mag_xyz_uT( +struct bno055_mag_double_t *mag_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_mag_t reg_mag_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read raw mag xyz data */ + com_rslt = bno055_read_mag_xyz(®_mag_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw mag xyz to microTesla*/ + mag_xyz->x = + (double)(reg_mag_xyz.x/BNO055_MAG_DIV_UT); + mag_xyz->y = + (double)(reg_mag_xyz.y/BNO055_MAG_DIV_UT); + mag_xyz->z = + (double)(reg_mag_xyz.z/BNO055_MAG_DIV_UT); + } else { + com_rslt = BNO055_ERROR; + } + + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro x raw data + * to dps output as double + * + * @param gyro_x_d : The gyro x dps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_x_dps( +double *gyro_x_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_x_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_x(®_gyro_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro x to dps */ + data_d = + (double)(reg_gyro_x_s16/BNO055_GYRO_DIV_DPS); + *gyro_x_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro x raw data + * to rps output as double + * + * @param gyro_x_d : The gyro x dps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_x_rps( +double *gyro_x_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_x_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_x(®_gyro_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro x to rps */ + data_d = + (double)(reg_gyro_x_s16/BNO055_GYRO_DIV_RPS); + *gyro_x_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro y raw data + * to dps output as double + * + * @param gyro_y_d : The gyro y dps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_y_dps( +double *gyro_y_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw y data */ + com_rslt += bno055_read_gyro_y(®_gyro_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro y to dps */ + data_d = + (double)(reg_gyro_y_s16/BNO055_GYRO_DIV_DPS); + *gyro_y_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro y raw data + * to rps output as double + * + * @param gyro_y_d : The gyro y dps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_y_rps( +double *gyro_y_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw y data */ + com_rslt += bno055_read_gyro_y(®_gyro_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro y to rps */ + data_d = + (double)(reg_gyro_y_s16/BNO055_GYRO_DIV_RPS); + *gyro_y_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro z raw data + * to dps output as double + * + * @param gyro_z_d : The gyro z dps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_z_dps( +double *gyro_z_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw z data */ + com_rslt += bno055_read_gyro_z(®_gyro_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro z to dps */ + data_d = + (double)(reg_gyro_z_s16/BNO055_GYRO_DIV_DPS); + *gyro_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro z raw data + * to rps output as double + * + * @param gyro_z_d : The gyro z rps double data + * + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_z_rps( +double *gyro_z_d) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gyro_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_z(®_gyro_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gyro x to rps */ + data_d = + (double)(reg_gyro_z_s16/BNO055_GYRO_DIV_RPS); + *gyro_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro xyz raw data + * to dps output as double + * + * @param gyro_xyz : The dps data of gyro xyz + * + * Parameter | result + * --------- | ----------------- + * x | dps data of gyro + * y | dps data of gyro + * z | dps data of gyro + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_xyz_dps( +struct bno055_gyro_double_t *gyro_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gyro_t reg_gyro_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as dps if the unit is in rps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_DPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_DPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw xyz data */ + com_rslt += bno055_read_gyro_xyz(®_gyro_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert gyro raw xyz to dps*/ + gyro_xyz->x = + (double)(reg_gyro_xyz.x/BNO055_GYRO_DIV_DPS); + gyro_xyz->y = + (double)(reg_gyro_xyz.y/BNO055_GYRO_DIV_DPS); + gyro_xyz->z = + (double)(reg_gyro_xyz.z/BNO055_GYRO_DIV_DPS); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gyro xyz raw data + * to rps output as double + * + * @param gyro_xyz : The rps data of gyro xyz + * + * Parameter | result + * --------- | ----------------- + * x | rps data of gyro + * y | rps data of gyro + * z | rps data of gyro + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gyro_xyz_rps( +struct bno055_gyro_double_t *gyro_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gyro_t reg_gyro_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 gyro_unit_u8 = BNO055_INIT_VALUE; + /* Read the current gyro unit and set the + unit as rps if the unit is in dps */ + com_rslt = bno055_get_gyro_unit(&gyro_unit_u8); + if (gyro_unit_u8 != BNO055_GYRO_UNIT_RPS) + com_rslt += bno055_set_gyro_unit(BNO055_GYRO_UNIT_RPS); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro raw x data */ + com_rslt += bno055_read_gyro_xyz(®_gyro_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw gyro xyz to rps*/ + gyro_xyz->x = + (double)(reg_gyro_xyz.x/BNO055_GYRO_DIV_RPS); + gyro_xyz->y = + (double)(reg_gyro_xyz.y/BNO055_GYRO_DIV_RPS); + gyro_xyz->z = + (double)(reg_gyro_xyz.z/BNO055_GYRO_DIV_RPS); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler h raw data + * to degree output as double + * + * @param euler_h_d : The double value of Euler h degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_h_deg( +double *euler_h_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_h_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw h data*/ + com_rslt += bno055_read_euler_h(®_euler_h_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler h to degree */ + data_d = + (double)(reg_euler_h_s16/BNO055_EULER_DIV_DEG); + *euler_h_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler h raw data + * to radians output as double + * + * @param euler_h_d : The double value of Euler h radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_h_rad( +double *euler_h_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_h_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw h data*/ + com_rslt += bno055_read_euler_h(®_euler_h_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler h to radians */ + data_d = + (double)(reg_euler_h_s16/BNO055_EULER_DIV_RAD); + *euler_h_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler r raw data + * to degree output as double + * + * @param euler_r_d : The double value of Euler r degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_r_deg( +double *euler_r_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_r_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw r data*/ + com_rslt += bno055_read_euler_r(®_euler_r_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler r to degree */ + data_d = + (double)(reg_euler_r_s16/BNO055_EULER_DIV_DEG); + *euler_r_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler r raw data + * to radians output as double + * + * @param euler_r_d : The double value of Euler r radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_r_rad( +double *euler_r_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_r_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw r data*/ + com_rslt += bno055_read_euler_r(®_euler_r_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler r to radians */ + data_d = + (double)(reg_euler_r_s16/BNO055_EULER_DIV_RAD); + *euler_r_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler p raw data + * to degree output as double + * + * @param euler_p_d : The double value of Euler p degree + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_p_deg( +double *euler_p_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_p_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw p data*/ + com_rslt += bno055_read_euler_p(®_euler_p_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler p to degree*/ + data_d = + (double)(reg_euler_p_s16/BNO055_EULER_DIV_DEG); + *euler_p_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler p raw data + * to radians output as double + * + * @param euler_p_d : The double value of Euler p radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_p_rad( +double *euler_p_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_euler_p_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw p data*/ + com_rslt += bno055_read_euler_p(®_euler_p_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw p to radians*/ + data_d = + (double)(reg_euler_p_s16/BNO055_EULER_DIV_RAD); + *euler_p_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler hpr raw data + * to degree output as double + * + * @param euler_hpr : The degree data of Euler hpr + * + * Parameter | result + * --------- | ----------------- + * h | degree data of Euler + * r | degree data of Euler + * p | degree data of Euler + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_hpr_deg( +struct bno055_euler_double_t *euler_hpr) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_euler_t reg_euler = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as degree if the unit is in radians */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_DEG) + com_rslt += bno055_set_euler_unit(BNO055_EULER_UNIT_DEG); + if (com_rslt == BNO055_SUCCESS) { + /* Read Euler raw h data*/ + com_rslt += bno055_read_euler_hrp(®_euler); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler hrp to degree*/ + euler_hpr->h = + (double)(reg_euler.h/BNO055_EULER_DIV_DEG); + euler_hpr->p = + (double)(reg_euler.p/BNO055_EULER_DIV_DEG); + euler_hpr->r = + (double)(reg_euler.r/BNO055_EULER_DIV_DEG); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the Euler hpr raw data + * to radians output as double + * + * @param euler_hpr : The radians data of Euler hpr + * + * Parameter | result + * --------- | ----------------- + * h | radians data of Euler + * r | radians data of Euler + * p | radians data of Euler + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_euler_hpr_rad( +struct bno055_euler_double_t *euler_hpr) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_euler_t reg_euler = {BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + u8 euler_unit_u8 = BNO055_INIT_VALUE; + /* Read the current Euler unit and set the + unit as radians if the unit is in degree */ + com_rslt = bno055_get_euler_unit(&euler_unit_u8); + if (euler_unit_u8 != BNO055_EULER_UNIT_RAD) + com_rslt = bno055_set_euler_unit(BNO055_EULER_UNIT_RAD); + if (com_rslt == BNO055_SUCCESS) { + /* Read the raw hrp */ + com_rslt = bno055_read_euler_hrp(®_euler); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw Euler hrp to radians*/ + euler_hpr->h = + (double)(reg_euler.h/BNO055_EULER_DIV_RAD); + euler_hpr->p = + (double)(reg_euler.p/BNO055_EULER_DIV_RAD); + euler_hpr->r = + (double)(reg_euler.r/BNO055_EULER_DIV_RAD); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel x raw data to meterpersecseq output as double + * + * @param linear_accel_x_d : The double value of + * linear accel x meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_linear_accel_x_msq( +double *linear_accel_x_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_x_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_x(®_linear_accel_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw x to m/s2 */ + data_d = (double) + (reg_linear_accel_x_s16/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_x_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel y raw data to meterpersecseq output as double + * + * @param linear_accel_y_d : The double value of + * linear accel y meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_linear_accel_y_msq( +double *linear_accel_y_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_y(®_linear_accel_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw y to m/s2 */ + data_d = (double) + (reg_linear_accel_y_s16/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_y_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear + * accel z raw data to meterpersecseq output as double + * + * @param linear_accel_z_d : The double value of + * linear accel z meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_linear_accel_z_msq( +double *linear_accel_z_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_linear_accel_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read the raw x of linear accel */ + com_rslt = bno055_read_linear_accel_z(®_linear_accel_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw z to m/s2 */ + data_d = + (double)(reg_linear_accel_z_s16/BNO055_LINEAR_ACCEL_DIV_MSQ); + *linear_accel_z_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the linear accel xyz raw data + * to meterpersecseq output as double + * + * @param linear_accel_xyz : The meterpersecseq data of linear accel xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of linear accel + * y | meterpersecseq data of linear accel + * z | meterpersecseq data of linear accel + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_linear_accel_xyz_msq( +struct bno055_linear_accel_double_t *linear_accel_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_linear_accel_t reg_linear_accel_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read the raw xyz of linear accel */ + com_rslt = bno055_read_linear_accel_xyz(®_linear_accel_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert the raw xyz of linear accel to m/s2 */ + linear_accel_xyz->x = + (double)(reg_linear_accel_xyz.x/BNO055_LINEAR_ACCEL_DIV_MSQ); + linear_accel_xyz->y = + (double)(reg_linear_accel_xyz.y/BNO055_LINEAR_ACCEL_DIV_MSQ); + linear_accel_xyz->z = + (double)(reg_linear_accel_xyz.z/BNO055_LINEAR_ACCEL_DIV_MSQ); + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * x raw data to meterpersecseq output as double + * + * @param gravity_x_d : The double value of gravity x meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_double_x_msq( +double *gravity_x_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_x_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw gravity of x*/ + com_rslt = bno055_read_gravity_x(®_gravity_x_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gravity of x to m/s2 */ + data_d = + (double)(reg_gravity_x_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_x_d = data_d; + } else { + com_rslt = BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * y raw data to meterpersecseq output as double + * + * @param gravity_y_d : The double value of gravity y meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_double_y_msq( +double *gravity_y_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_y_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw gravity of y */ + com_rslt = bno055_read_gravity_y(®_gravity_y_s16); + if (com_rslt == BNO055_SUCCESS) { + /* convert raw gravity of y to m/s2 */ + data_d = + (double)(reg_gravity_y_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_y_d = data_d; + } else { + com_rslt += BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity + * z raw data to meterpersecseq output as double + * + * @param gravity_z_d : The double value of gravity z meterpersecseq + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_gravity_double_z_msq( +double *gravity_z_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s16 reg_gravity_z_s16 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + /* Read raw gravity of z */ + com_rslt = bno055_read_gravity_z(®_gravity_z_s16); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gravity of z to m/s2 */ + data_d = + (double)(reg_gravity_z_s16/BNO055_GRAVITY_DIV_MSQ); + *gravity_z_d = data_d; + } else { + com_rslt += BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the gravity xyz raw data + * to meterpersecseq output as double + * + * @param gravity_xyz : The meterpersecseq data of gravity xyz + * + * Parameter | result + * --------- | ----------------- + * x | meterpersecseq data of gravity + * y | meterpersecseq data of gravity + * z | meterpersecseq data of gravity + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_gravity_xyz_msq( +struct bno055_gravity_double_t *gravity_xyz) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + struct bno055_gravity_t reg_gravity_xyz = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + /* Read raw gravity of xyz */ + com_rslt = bno055_read_gravity_xyz(®_gravity_xyz); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw gravity of xyz to m/s2 */ + gravity_xyz->x = + (double)(reg_gravity_xyz.x/BNO055_GRAVITY_DIV_MSQ); + gravity_xyz->y = + (double)(reg_gravity_xyz.y/BNO055_GRAVITY_DIV_MSQ); + gravity_xyz->z = + (double)(reg_gravity_xyz.z/BNO055_GRAVITY_DIV_MSQ); + } else { + com_rslt += BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the temperature + * data to Fahrenheit output as double + * + * @param temp_d : The double value of temperature Fahrenheit + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_temp_fahrenheit( +double *temp_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s8 reg_temp_s8 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 temp_unit_u8 = BNO055_INIT_VALUE; + /* Read the current temperature unit and set the + unit as Fahrenheit if the unit is in Celsius */ + com_rslt = bno055_get_temp_unit(&temp_unit_u8); + if (temp_unit_u8 != BNO055_TEMP_UNIT_FAHRENHEIT) + com_rslt += bno055_set_temp_unit(BNO055_TEMP_UNIT_FAHRENHEIT); + if (com_rslt == BNO055_SUCCESS) { + /* Read the raw temperature data */ + com_rslt += bno055_read_temp_data(®_temp_s8); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw temperature data to Fahrenheit*/ + data_d = (double)(reg_temp_s8/ + BNO055_TEMP_DIV_FAHRENHEIT); + *temp_d = data_d; + } else { + com_rslt += BNO055_ERROR; + } + } else { + com_rslt += BNO055_ERROR; + } + return com_rslt; +} +/*! + * @brief This API is used to convert the temperature + * data to Celsius output as double + * + * @param temp_d : The double value of temperature Celsius + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_convert_double_temp_celsius( +double *temp_d) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + s8 reg_temp_s8 = BNO055_INIT_VALUE; + double data_d = BNO055_INIT_VALUE; + u8 temp_unit_u8 = BNO055_INIT_VALUE; + /* Read the current temperature unit and set the + unit as Fahrenheit if the unit is in Celsius */ + com_rslt = bno055_get_temp_unit(&temp_unit_u8); + if (temp_unit_u8 != BNO055_TEMP_UNIT_CELSIUS) + com_rslt += bno055_set_temp_unit(BNO055_TEMP_UNIT_CELSIUS); + if (com_rslt == BNO055_SUCCESS) { + /* Read the raw temperature data */ + com_rslt += bno055_read_temp_data(®_temp_s8); + if (com_rslt == BNO055_SUCCESS) { + /* Convert raw temperature data to Fahrenheit*/ + data_d = + (double)(reg_temp_s8/BNO055_TEMP_DIV_CELSIUS); + *temp_d = data_d; + } else { + com_rslt += BNO055_ERROR; + } + } else { + com_rslt += BNO055_ERROR; + } + return com_rslt; +} +#endif +/*! + * @brief This API used to read + * mag calibration status from register from 0x35 bit 0 and 1 + * + * @param mag_calib_u8 : The value of mag calib status + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_calib_stat( +u8 *mag_calib_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, mag calib + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the mag calib stat_s8 */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_CALIB_STAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *mag_calib_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_CALIB_STAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * accel calibration status from register from 0x35 bit 2 and 3 + * + * @param accel_calib_u8 : The value of accel calib status + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_calib_stat( +u8 *accel_calib_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty*/ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel calib + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel calib stat_s8 */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_CALIB_STAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_calib_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_CALIB_STAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * gyro calibration status from register from 0x35 bit 4 and 5 + * + * @param gyro_calib_u8 : The value of gyro calib status + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_calib_stat( +u8 *gyro_calib_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro calib + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro calib status */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_CALIB_STAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_calib_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_CALIB_STAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * system calibration status from register from 0x35 bit 6 and 7 + * + * @param sys_calib_u8 : The value of system calib status + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_sys_calib_stat( +u8 *sys_calib_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty*/ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,system calib + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the system calib */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_CALIB_STAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sys_calib_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_SYS_CALIB_STAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * all calibration status from register from 0x35 + * + * @param all_calib_u8 : The value of system calib status + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_all_calib_stat( +u8 *all_calib_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty*/ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,system calib + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the system calib */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ALL_CALIB_STAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *all_calib_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_ALL_CALIB_STAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * self test of accel from register from 0x36 bit 0 + * + * @param selftest_accel_u8 : The value of self test of accel + * + * selftest_accel_u8 | result + * -------------------- | --------------------- + * 0x00 | indicates test failed + * 0x01 | indicated test passed + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_selftest_accel( +u8 *selftest_accel_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel self test is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel self test */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_ACCEL_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *selftest_accel_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_SELFTEST_ACCEL); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * self test of mag from register from 0x36 bit 1 + * + * @param selftest_mag_u8 : The value of self test of mag + * + * selftest_mag_u8 | result + * -------------------- | --------------------- + * 0x00 | indicates test failed + * 0x01 | indicated test passed + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_selftest_mag( +u8 *selftest_mag_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, self test of mag is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the mag self test */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_MAG_REG, &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *selftest_mag_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_SELFTEST_MAG); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * self test of gyro from register from 0x36 bit 2 + * + * @param selftest_gyro_u8 : The value of self test of gyro + * + * selftest_gyro_u8 | result + * -------------------- | --------------------- + * 0x00 | indicates test failed + * 0x01 | indicated test passed + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_selftest_gyro( +u8 *selftest_gyro_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page self test of gyro is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro self test */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_GYRO_REG, &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *selftest_gyro_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_SELFTEST_GYRO); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read + * self test of micro controller from register from 0x36 bit 3 + * + * @param selftest_mcu_u8 : The value of self test of micro controller + * + * selftest_mcu_u8 | result + * -------------------- | --------------------- + * 0x00 | indicates test failed + * 0x01 | indicated test passed + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_selftest_mcu( +u8 *selftest_mcu_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page self test of micro controller + is available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the self test of micro controller*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_MCU_REG, &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *selftest_mcu_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_SELFTEST_MCU); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the stat_s8 of + * gyro anymotion interrupt from register from 0x37 bit 2 + * + * @param gyro_any_motion_u8 : The value of gyro anymotion interrupt + * + * gyro_any_motion_u8 | result + * -------------------- | --------------------- + * 0x00 | indicates no interrupt triggered + * 0x01 | indicates interrupt triggered + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro anymotion interrupt can be BNO055_BIT_ENABLE + * by the following APIs + * + * bno055_set_intr_mask_gyro_any_motion() + * + * bno055_set_intr_gyro_any_motion() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_stat_gyro_any_motion( +u8 *gyro_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion interrupt + status is available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro anymotion interrupt stat_s8*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_STAT_GYRO_ANY_MOTION_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_INTR_STAT_GYRO_ANY_MOTION); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the stat_s8 of + * gyro highrate interrupt from register from 0x37 bit 3 + * + * @param gyro_highrate_u8 : The value of gyro highrate interrupt + * + * gyro_highrate_u8 | result + * ------------------- | --------------------- + * 0x00 | indicates no interrupt triggered + * 0x01 | indicates interrupt triggered + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate interrupt can be configured + * by the following APIs + * + * bno055_set_intr_mask_gyro_highrate() + * + * bno055_set_intr_gyro_highrate() + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_stat_gyro_highrate( +u8 *gyro_highrate_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro highrate interrupt stat_s8*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_STAT_GYRO_HIGHRATE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_INTR_STAT_GYRO_HIGHRATE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the stat_s8 of + * accel highg interrupt from register from 0x37 bit 5 + * + * @param accel_high_g_u8 : The value of accel highg interrupt + * + * accel_high_g_u8 | result + * ------------------- | --------------------- + * 0x00 | indicates no interrupt triggered + * 0x01 | indicates interrupt triggered + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel highg interrupt can be configured + * by the following APIs + * + * bno055_set_intr_mask_accel_high_g() + * + * bno055_set_intr_accel_high_g() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_stat_accel_high_g( +u8 *accel_high_g_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel highg interrupt stat_s8 */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_STAT_ACCEL_HIGH_G_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_high_g_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_INTR_STAT_ACCEL_HIGH_G); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the stat_s8 of + * accel anymotion interrupt from register from 0x37 bit 6 + * + * @param accel_any_motion_u8 : The value of accel anymotion interrupt + * + * accel_any_motion_u8 | result + * ------------------- | --------------------- + * 0x00 | indicates no interrupt triggered + * 0x01 | indicates interrupt triggered + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel anymotion interrupt can be configured + * by the following APIs + * + * bno055_set_intr_mask_accel_any_motion() + * + * bno055_set_intr_accel_any_motion() + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_stat_accel_any_motion( +u8 *accel_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel anymotion interrupt stat_s8 */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_STAT_ACCEL_ANY_MOTION_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_INTR_STAT_ACCEL_ANY_MOTION); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the stat_s8 of + * accel nomotion/slowmotion interrupt from register from 0x37 bit 6 + * + * @param accel_no_motion_u8 : The value of accel + * nomotion/slowmotion interrupt + * + * accel_no_motion_u8 | result + * ------------------- | --------------------- + * 0x00 | indicates no interrupt triggered + * 0x01 | indicates interrupt triggered + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel nomotion/slowmotion interrupt can be configured + * by the following APIs + * + * bno055_set_intr_mask_accel_nomotion() + * + * bno055_set_intr_accel_nomotion() + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_stat_accel_no_motion( +u8 *accel_no_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel + nomotion/slowmotion interrupt + is available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the stat_s8 of accel + nomotion/slowmotion interrupt*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_STAT_ACCEL_NO_MOTION_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_no_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_INTR_STAT_ACCEL_NO_MOTION); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to read status of main clock + * from the register 0x38 bit 0 + * + * @param stat_main_clk_u8 : the status of main clock + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_stat_main_clk( +u8 *stat_main_clk_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, status of main clk is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the status of main clk */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_MAIN_CLK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *stat_main_clk_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_SYS_MAIN_CLK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to read system status + * code from the register 0x39 it is a byte of data + * + * @param sys_stat_u8 : the status of system + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_sys_stat_code( +u8 *sys_stat_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, the status of system is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the the status of system*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_STAT_CODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sys_stat_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_SYS_STAT_CODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to read system BNO055_ERROR + * code from the register 0x3A it is a byte of data + * + * @param sys_error_u8 : The value of system BNO055_ERROR code + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_sys_error_code( +u8 *sys_error_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, system BNO055_ERROR code is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the system BNO055_ERROR code*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_ERROR_CODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sys_error_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_SYS_ERROR_CODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel unit + * from register from 0x3B bit 0 + * + * @param accel_unit_u8 : The value of accel unit + * + * accel_unit_u8 | result + * ------------- | --------------- + * 0x00 | BNO055_ACCEL_UNIT_MSQ + * 0x01 | BNO055_ACCEL_UNIT_MG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_unit( +u8 *accel_unit_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel unit is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the accel unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_unit_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_ACCEL_UNIT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel unit + * from register from 0x3B bit 0 + * + * @param accel_unit_u8 : The value of accel unit + * + * accel_unit_u8 | result + * ------------- | --------------- + * 0x00 | BNO055_ACCEL_UNIT_MSQ + * 0x01 | BNO055_ACCEL_UNIT_MG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_unit( +u8 accel_unit_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the accel unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_UNIT, accel_unit_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_UNIT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the gyro unit + * from register from 0x3B bit 1 + * + * @param gyro_unit_u8 : The value of accel unit + * + * gyro_unit_u8 | result + * ------------- | ----------- + * 0x00 | BNO055_GYRO_UNIT_DPS + * 0x01 | BNO055_GYRO_UNIT_RPS + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_unit( +u8 *gyro_unit_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro unit is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the gyro unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_unit_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_GYRO_UNIT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro unit + * from register from 0x3B bit 1 + * + * @param gyro_unit_u8 : The value of accel unit + * + * gyro_unit_u8 | result + * ------------- | ----------- + * 0x00 | BNO055_GYRO_UNIT_DPS + * 0x01 | BNO055_GYRO_UNIT_RPS + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_unit(u8 gyro_unit_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the gyro unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_UNIT, gyro_unit_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_UNIT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the Euler unit + * from register from 0x3B bit 2 + * + * @param euler_unit_u8 : The value of accel unit + * + * euler_unit_u8 | result + * -------------- | ----------- + * 0x00 | BNO055_EULER_UNIT_DEG + * 0x01 | BNO055_EULER_UNIT_RAD + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_euler_unit( +u8 *euler_unit_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, Euler unit is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the Euler unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *euler_unit_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_EULER_UNIT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the Euler unit + * from register from 0x3B bit 2 + * + * @param euler_unit_u8 : The value of Euler unit + * + * euler_unit_u8 | result + * -------------- | ----------- + * 0x00 | BNO055_EULER_UNIT_DEG + * 0x01 | BNO055_EULER_UNIT_RAD + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_euler_unit(u8 euler_unit_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the Euler unit*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_EULER_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_EULER_UNIT, euler_unit_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_EULER_UNIT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to write the tilt unit + * from register from 0x3B bit 3 + * + * @param tilt_unit_u8 : The value of tilt unit + * + * tilt_unit_u8 | result + * --------------- | --------- + * 0x00 | degrees + * 0x01 | radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_tilt_unit( +u8 *tilt_unit_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, chip id is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TILT_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *tilt_unit_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_TILT_UNIT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the tilt unit + * from register from 0x3B bit 3 + * + * @param tilt_unit_u8 : The value of tilt unit + * + * tilt_unit_u8 | result + * --------------- | --------- + * 0x00 | degrees + * 0x01 | radians + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + * + * \return Communication results + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_tilt_unit(u8 tilt_unit_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TILT_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_TILT_UNIT, tilt_unit_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_TILT_UNIT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the temperature unit + * from register from 0x3B bit 4 + * + * @param temp_unit_u8 : The value of temperature unit + * + * temp_unit_u8 | result + * ----------- | -------------- + * 0x00 | BNO055_TEMP_UNIT_CELSIUS + * 0x01 | BNO055_TEMP_UNIT_FAHRENHEIT + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_temp_unit( +u8 *temp_unit_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, temperature unit is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the temperature unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *temp_unit_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_TEMP_UNIT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the temperature unit + * from register from 0x3B bit 4 + * + * @param temp_unit_u8 : The value of temperature unit + * + * temp_unit_u8 | result + * ----------- | -------------- + * 0x00 | BNO055_TEMP_UNIT_CELSIUS + * 0x01 | BNO055_TEMP_UNIT_FAHRENHEIT + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_temp_unit( +u8 temp_unit_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the temperature unit */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_UNIT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_TEMP_UNIT, + temp_unit_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_UNIT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the current selected orientation mode + * from register from 0x3B bit 7 + * + * @param data_output_format_u8 : The value of data output format + * + * data_output_format_u8 | result + * -------------------- | -------- + * 0x00 | Windows + * 0x01 | Android + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_data_output_format( +u8 *data_output_format_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, data output format is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the data output format */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_DATA_OUTPUT_FORMAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_output_format_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_DATA_OUTPUT_FORMAT); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the current selected orientation mode + * from register from 0x3B bit 7 + * + * @param data_output_format_u8 : The value of data output format + * + * data_output_format_u8 | result + * -------------------- | -------- + * 0x00 | Windows + * 0x01 | Android + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_data_output_format( +u8 data_output_format_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the data output format */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_DATA_OUTPUT_FORMAT_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_DATA_OUTPUT_FORMAT, + data_output_format_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_DATA_OUTPUT_FORMAT_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! @brief This API used to read the operation mode + * from register from 0x3D bit 0 to 3 + * + * @param operation_mode_u8 : The value of operation mode + * + * operation_mode_u8 | result | comments + * ----------|----------------------------|---------------------------- + * 0x00 | BNO055_OPERATION_MODE_CONFIG | Configuration mode + * 0x01 | BNO055_OPERATION_MODE_ACCONLY | Reads accel data alone + * 0x02 | BNO055_OPERATION_MODE_MAGONLY | Reads mag data alone + * 0x03 | BNO055_OPERATION_MODE_GYRONLY | Reads gyro data alone + * 0x04 | BNO055_OPERATION_MODE_ACCMAG | Reads accel and mag data + * 0x05 | BNO055_OPERATION_MODE_ACCGYRO | Reads accel and gyro data + * 0x06 | BNO055_OPERATION_MODE_MAGGYRO | Reads accel and mag data + * 0x07 | OPERATION_MODE_ANY_MOTION | Reads accel mag and gyro data + * 0x08 | BNO055_OPERATION_MODE_IMUPLUS | Inertial measurement unit + * - | - | Reads accel,gyro and fusion data + * 0x09 | BNO055_OPERATION_MODE_COMPASS | Reads accel, mag data + * - | - | and fusion data + * 0x0A | BNO055_OPERATION_MODE_M4G | Reads accel, mag data + * - | - | and fusion data + * 0x0B | BNO055_OPERATION_MODE_NDOF_FMC_OFF| Nine degrees of freedom with + * - | - | fast magnetic calibration + * - | - | Reads accel,mag, gyro + * - | - | and fusion data + * 0x0C | BNO055_OPERATION_MODE_NDOF | Nine degrees of freedom + * - | - | Reads accel,mag, gyro + * - | - | and fusion data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note In the config mode, all sensor and fusion data + * becomes zero and it is mainly derived + * to configure the various settings of the BNO + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_operation_mode( +u8 *operation_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, operation mode is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of operation mode*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *operation_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_OPERATION_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! @brief This API used to write the operation mode + * from register from 0x3D bit 0 to 3 + * + * @param operation_mode_u8 : The value of operation mode + * + * operation_mode_u8 | result | comments + * ---------|-----------------------------------|-------------------------- + * 0x00 | BNO055_OPERATION_MODE_CONFIG | Configuration mode + * 0x01 | BNO055_OPERATION_MODE_ACCONLY | Reads accel data alone + * 0x02 | BNO055_OPERATION_MODE_MAGONLY | Reads mag data alone + * 0x03 | BNO055_OPERATION_MODE_GYRONLY | Reads gyro data alone + * 0x04 | BNO055_OPERATION_MODE_ACCMAG | Reads accel and mag data + * 0x05 | BNO055_OPERATION_MODE_ACCGYRO | Reads accel and gyro data + * 0x06 | BNO055_OPERATION_MODE_MAGGYRO | Reads accel and mag data + * 0x07 | OPERATION_MODE_ANY_MOTION | Reads accel mag and + * | - | gyro data + * 0x08 | BNO055_OPERATION_MODE_IMUPLUS | Inertial measurement unit + * - | | Reads accel,gyro and + * | - | fusion data + * 0x09 | BNO055_OPERATION_MODE_COMPASS | Reads accel, mag data + * - | - | and fusion data + * 0x0A | BNO055_OPERATION_MODE_M4G | Reads accel, mag data + * - | - | and fusion data + * 0x0B | BNO055_OPERATION_MODE_NDOF_FMC_OFF| Nine degrees of freedom with + * - | - | fast magnetic calibration + * - | - | Reads accel,mag, gyro + * - | - | and fusion data + * 0x0C | BNO055_OPERATION_MODE_NDOF | Nine degrees of freedom + * - | - | Reads accel,mag, gyro + * - | - | and fusion data + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note In the config mode, all sensor and fusion data + * becomes zero and it is mainly derived + * to configure the various settings of the BNO + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_operation_mode(u8 operation_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + /* If the previous operation mode is config it is + directly write the operation mode */ + if (prev_opmode_u8 == BNO055_OPERATION_MODE_CONFIG) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_OPERATION_MODE, + operation_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + /* Config mode to other + operation mode switching + required delay of 600ms*/ + p_bno055->delay_msec( + BNO055_MODE_SWITCHING_DELAY); + } + } else { + /* If the previous operation + mode is not config it is + write the config mode */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_OPERATION_MODE, + BNO055_OPERATION_MODE_CONFIG); + com_rslt += bno055_write_register( + BNO055_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + /* other mode to config mode switching + required delay of 20ms*/ + p_bno055->delay_msec( + BNO055_CONFIG_MODE_SWITCHING_DELAY); + } + /* Write the operation mode */ + if (operation_mode_u8 != + BNO055_OPERATION_MODE_CONFIG) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_OPERATION_MODE, + operation_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + /* Config mode to other + operation mode switching + required delay of 600ms*/ + p_bno055->delay_msec( + BNO055_MODE_SWITCHING_DELAY); + } + } + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! @brief This API used to read the power mode + * from register from 0x3E bit 0 to 1 + * + * @param power_mode_u8 : The value of power mode + * + * power_mode_u8| result | comments + * ---------|---------------------------|------------------------------------- + * 0x00 |BNO055_POWER_MODE_NORMAL | In the NORMAL mode the register + * - | - | map and the internal peripherals + * - | - | of the MCU are always + * - | - | operative in this mode + * 0x01 |BNO055_POWER_MODE_LOWPOWER | This is first level of power + * | - | saving mode + * 0x02 |BNO055_POWER_MODE_SUSPEND | In suspend mode the system is + * - | - | paused and all the sensors and + * - | - | the micro controller are + * - | - | put into sleep mode. + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note For detailed about LOWPOWER mode + * refer data sheet 3.4.2 + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_power_mode( +u8 *power_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, power mode is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of power mode */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *power_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_POWER_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! @brief This API used to write the power mode + * from register from 0x3E bit 0 to 1 + * + * @param power_mode_u8 : The value of power mode + * + * + * power_mode_u8| result | comments + * -------|----------------------------|--------------------------------- + * 0x00 | BNO055_POWER_MODE_NORMAL | In the NORMAL mode the register + * - | - | map and the internal peripherals + * - | - | of the MCU are always + * - | - | operative in this mode + * 0x01 | BNO055_POWER_MODE_LOWPOWER | This is first level of power + * | - | saving mode + * 0x02 | BNO055_POWER_MODE_SUSPEND | In suspend mode the system is + * - | - | paused and all the sensors and + * - | - | the micro controller are + * - | - | put into sleep mode. + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note For detailed about LOWPOWER mode + * refer data sheet 3.4.2 + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_power_mode(u8 power_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of power mode */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_POWER_MODE, power_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the reset interrupt + * from register from 0x3F bit 6 + * It resets all the interrupt bit and interrupt output + * + * @param intr_rst_u8 : The value of reset interrupt + * + * intr_rst_u8 | result + * ------------ |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_rst( +u8 *intr_rst_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, reset interrupt is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of reset interrupt*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *intr_rst_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_INTR_RST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the reset interrupt + * from register from 0x3F bit 6 + * It resets all the interrupt bit and interrupt output + * + * @param intr_rst_u8 : The value of reset interrupt + * + * intr_rst_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_rst(u8 intr_rst_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, reset interrupt + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Write the value of reset interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_INTR_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_INTR_RST, intr_rst_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_INTR_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the clk source + * from register from 0x3F bit 7 + * + * @param clk_src_u8 : The value of clk source + * + * clk_src_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_clk_src( +u8 *clk_src_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, clk source is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of clk source */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_CLK_SRC_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *clk_src_u8 = + BNO055_GET_BITSLICE(data_u8r, BNO055_CLK_SRC); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the clk source + * from register from 0x3F bit 7 + * + * @param clk_src_u8 : The value of clk source + * + * clk_src_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_clk_src(u8 clk_src_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, clk source is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Write the value of clk source */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_CLK_SRC_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_CLK_SRC, clk_src_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_CLK_SRC_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the reset system + * from register from 0x3F bit 5 + * + * @param sys_rst_u8 : The value of reset system + * + * sys_rst_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note It resets the whole system + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_sys_rst( +u8 *sys_rst_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, reset system is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of reset system */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sys_rst_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_SYS_RST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the reset system + * from register from 0x3F bit 5 + * + * @param sys_rst_u8 : The value of reset system + * + * sys_rst_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note It resets the whole system + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_sys_rst(u8 sys_rst_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, reset system is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Write the value of reset system */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SYS_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_SYS_RST, sys_rst_u8); + com_rslt = + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SYS_RST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the self test + * from register from 0x3F bit 0 + * + * @param selftest_u8 : The value of self test + * + * selftest_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note It triggers the self test + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_selftest( +u8 *selftest_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, self test is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of self test */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *selftest_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_SELFTEST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the self test + * from register from 0x3F bit 0 + * + * @param selftest_u8 : The value of self test + * + * selftest_u8 | result + * -------------- |---------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note It triggers the self test + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_selftest(u8 selftest_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of self test */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_SELFTEST, + selftest_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SELFTEST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the temperature source + * from register from 0x40 bit 0 and 1 + * + * @param temp_source_u8 : The value of selected temperature source + * + * temp_source_u8 | result + * ---------------- |--------------- + * 0x00 | BNO055_ACCEL_TEMP_EN + * 0X01 | BNO055_GYRO_TEMP_EN + * 0X03 | BNO055_MCU_TEMP_EN + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_temp_source( +u8 *temp_source_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, temperature source is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of temperature source */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_SOURCE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *temp_source_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_TEMP_SOURCE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the temperature source + * from register from 0x40 bit 0 and 1 + * + * @param temp_source_u8 : The value of selected temperature source + * + * temp_source_u8 | result + * ---------------- |--------------- + * 0x00 | BNO055_ACCEL_TEMP_EN + * 0X01 | BNO055_GYRO_TEMP_EN + * 0X03 | BNO055_MCU_TEMP_EN + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_temp_source(u8 temp_source_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of temperature source*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_SOURCE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_TEMP_SOURCE, temp_source_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_TEMP_SOURCE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the axis remap value + * from register from 0x41 bit 0 and 5 + * + * @param remap_axis_u8 : The value of axis remapping + * + * remap_axis_u8 | result | comments + * ------------|-------------------|------------ + * 0X21 | BNO055_REMAP_X_Y | Z=Z;X=Y;Y=X + * 0X18 | BNO055_REMAP_Y_Z | X=X;Y=Z;Z=Y + * 0X06 | BNO055_REMAP_Z_X | Y=Y;X=Z;Z=X + * 0X12 | BNO055_REMAP_X_Y_Z_TYPE0 | X=Z;Y=X;Z=Y + * 0X09 | BNO055_REMAP_X_Y_Z_TYPE1 | X=Y;Y=Z;Z=X + * 0X24 | BNO055_DEFAULT_AXIS | X=X;Y=Y;Z=Z + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note : For axis sign remap refer the following APIs + * x-axis : + * + * bno055_set_x_remap_sign() + * + * y-axis : + * + * bno055_set_y_remap_sign() + * + * z-axis : + * + * bno055_set_z_remap_sign() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_axis_remap_value( +u8 *remap_axis_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, axis remap is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of axis remap*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_AXIS_VALUE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *remap_axis_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_REMAP_AXIS_VALUE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the axis remap value + * from register from 0x41 bit 0 and 5 + * + * @param remap_axis_u8 : The value of axis remapping + * + * remap_axis_u8 | result | comments + * ------------|-------------------|------------ + * 0X21 | BNO055_REMAP_X_Y | Z=Z;X=Y;Y=X + * 0X18 | BNO055_REMAP_Y_Z | X=X;Y=Z;Z=Y + * 0X06 | BNO055_REMAP_Z_X | Y=Y;X=Z;Z=X + * 0X12 | BNO055_REMAP_X_Y_Z_TYPE0 | X=Z;Y=X;Z=Y + * 0X09 | BNO055_REMAP_X_Y_Z_TYPE1 | X=Y;Y=Z;Z=X + * 0X24 | BNO055_DEFAULT_AXIS | X=X;Y=Y;Z=Z + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note : For axis sign remap refer the following APIs + * x-axis : + * + * bno055_set_x_remap_sign() + * + * y-axis : + * + * bno055_set_y_remap_sign() + * + * z-axis : + * + * bno055_set_z_remap_sign() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_axis_remap_value( +u8 remap_axis_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + /* Write the value of axis remap */ + if (stat_s8 == BNO055_SUCCESS) { + switch (remap_axis_u8) { + case BNO055_REMAP_X_Y: + case BNO055_REMAP_Y_Z: + case BNO055_REMAP_Z_X: + case BNO055_REMAP_X_Y_Z_TYPE0: + case BNO055_REMAP_X_Y_Z_TYPE1: + case BNO055_DEFAULT_AXIS: + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_AXIS_VALUE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_REMAP_AXIS_VALUE, + remap_axis_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_AXIS_VALUE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + default: + /* Write the default axis remap value */ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_AXIS_VALUE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_REMAP_AXIS_VALUE, + BNO055_DEFAULT_AXIS); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_AXIS_VALUE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the x-axis remap + * sign from register from 0x42 bit 2 + * + * @param remap_x_sign_u8 : The value of x-axis remap sign + * + * remap_x_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_remap_x_sign( +u8 *remap_x_sign_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, x-axis remap sign is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of x-axis remap sign */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_X_SIGN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *remap_x_sign_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_REMAP_X_SIGN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the x-axis remap + * sign from register from 0x42 bit 2 + * + * @param remap_x_sign_u8 : The value of x-axis remap sign + * + * remap_x_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_remap_x_sign( +u8 remap_x_sign_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of x-axis remap */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_X_SIGN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_REMAP_X_SIGN, + remap_x_sign_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_X_SIGN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the y-axis remap + * sign from register from 0x42 bit 1 + * + * @param remap_y_sign_u8 : The value of y-axis remap sign + * + * remap_y_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_remap_y_sign( +u8 *remap_y_sign_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, y-axis remap sign is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of y-axis remap sign*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Y_SIGN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *remap_y_sign_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_REMAP_Y_SIGN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the y-axis remap + * sign from register from 0x42 bit 1 + * + * @param remap_y_sign_u8 : The value of y-axis remap sign + * + * remap_y_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_remap_y_sign( +u8 remap_y_sign_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of y-axis remap sign*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Y_SIGN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_REMAP_Y_SIGN, + remap_y_sign_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Y_SIGN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the z-axis remap + * sign from register from 0x42 bit 0 + * + * @param remap_z_sign_u8 : The value of z-axis remap sign + * + * remap_z_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_remap_z_sign( +u8 *remap_z_sign_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, z-axis remap sign is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read the value of z-axis remap sign*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Z_SIGN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *remap_z_sign_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_REMAP_Z_SIGN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the z-axis remap + * sign from register from 0x42 bit 0 + * + * @param remap_z_sign_u8 : The value of z-axis remap sign + * + * remap_z_sign_u8 | result + * ------------------- |-------------------- + * 0X00 | BNO055_REMAP_AXIS_POSITIVE + * 0X01 | BNO055_REMAP_AXIS_NEGATIVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_remap_z_sign( +u8 remap_z_sign_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write the value of z-axis remap sign*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Z_SIGN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_REMAP_Z_SIGN, + remap_z_sign_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_REMAP_Z_SIGN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API is used to read soft iron calibration matrix + * from the register 0x43 to 0x53 it is a 18 bytes of data + * + * @param sic_matrix : The value of soft iron calibration matrix + * + * sic_matrix | result + * --------------------|---------------------------------- + * sic_0 | soft iron calibration matrix zero + * sic_1 | soft iron calibration matrix one + * sic_2 | soft iron calibration matrix two + * sic_3 | soft iron calibration matrix three + * sic_4 | soft iron calibration matrix four + * sic_5 | soft iron calibration matrix five + * sic_6 | soft iron calibration matrix six + * sic_7 | soft iron calibration matrix seven + * sic_8 | soft iron calibration matrix eight + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note : Each soft iron calibration matrix range from -32768 to +32767 + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_sic_matrix( +struct bno055_sic_matrix_t *sic_matrix) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the soft iron calibration matrix values + data_u8[BNO055_SOFT_IRON_CALIB_0_LSB] - sic_0->LSB + data_u8[BNO055_SOFT_IRON_CALIB_0_MSB] - sic_0->MSB + data_u8[BNO055_SOFT_IRON_CALIB_1_LSB] - sic_1->LSB + data_u8[BNO055_SOFT_IRON_CALIB_1_MSB] - sic_1->MSB + data_u8[BNO055_SOFT_IRON_CALIB_2_LSB] - sic_2->LSB + data_u8[BNO055_SOFT_IRON_CALIB_2_MSB] - sic_2->MSB + data_u8[BNO055_SOFT_IRON_CALIB_3_LSB] - sic_3->LSB + data_u8[BNO055_SOFT_IRON_CALIB_3_MSB] - sic_3->MSB + data_u8[BNO055_SOFT_IRON_CALIB_4_LSB] - sic_4->LSB + data_u8[BNO055_SOFT_IRON_CALIB_4_MSB] - sic_4->MSB + data_u8[BNO055_SOFT_IRON_CALIB_5_LSB] - sic_5->LSB + data_u8[BNO055_SOFT_IRON_CALIB_5_MSB] - sic_5->MSB + data_u8[BNO055_SOFT_IRON_CALIB_6_LSB] - sic_6->LSB + data_u8[BNO055_SOFT_IRON_CALIB_6_MSB] - sic_6->MSB + data_u8[BNO055_SOFT_IRON_CALIB_7_LSB] - sic_7->LSB + data_u8[BNO055_SOFT_IRON_CALIB_7_MSB] - sic_7->MSB + data_u8[BNO055_SOFT_IRON_CALIB_8_LSB] - sic_8->LSB + data_u8[BNO055_SOFT_IRON_CALIB_8_MSB] - sic_8->MSB + */ + u8 data_u8[BNO055_SOFT_IRON_CALIBRATION_MATRIX_SIZE] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, soft iron calibration matrix is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read soft iron calibration matrix value + it is eighteen bytes of data */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_0_LSB_REG, + data_u8, BNO055_SOFT_IRON_CALIBRATION_MATRIX_SIZE); + if (com_rslt == BNO055_SUCCESS) { + /*soft iron calibration matrix zero*/ + data_u8[BNO055_SOFT_IRON_CALIB_0_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_0_LSB], + BNO055_SIC_MATRIX_0_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_0_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_0_MSB], + BNO055_SIC_MATRIX_0_MSB); + sic_matrix->sic_0 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_0_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SOFT_IRON_CALIB_0_LSB])); + + /*soft iron calibration matrix one*/ + data_u8[BNO055_SOFT_IRON_CALIB_1_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_1_LSB], + BNO055_SIC_MATRIX_1_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_1_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_1_MSB], + BNO055_SIC_MATRIX_1_MSB); + sic_matrix->sic_1 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_1_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SOFT_IRON_CALIB_1_LSB])); + + /*soft iron calibration matrix two*/ + data_u8[BNO055_SOFT_IRON_CALIB_2_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_2_LSB], + BNO055_SIC_MATRIX_2_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_2_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_2_MSB], + BNO055_SIC_MATRIX_2_MSB); + sic_matrix->sic_2 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_2_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SOFT_IRON_CALIB_2_LSB])); + + /*soft iron calibration matrix three*/ + data_u8[BNO055_SOFT_IRON_CALIB_3_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_3_LSB], + BNO055_SIC_MATRIX_3_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_3_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_3_MSB], + BNO055_SIC_MATRIX_3_LSB); + sic_matrix->sic_3 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_3_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_3_LSB])); + + /*soft iron calibration matrix four*/ + data_u8[BNO055_SOFT_IRON_CALIB_4_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_4_LSB], + BNO055_SIC_MATRIX_4_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_4_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_4_MSB], + BNO055_SIC_MATRIX_4_LSB); + sic_matrix->sic_4 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_4_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_4_LSB])); + + /*soft iron calibration matrix five*/ + data_u8[BNO055_SOFT_IRON_CALIB_5_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_5_LSB], + BNO055_SIC_MATRIX_5_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_5_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_5_MSB], + BNO055_SIC_MATRIX_5_LSB); + sic_matrix->sic_5 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_5_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_5_LSB])); + + /*soft iron calibration matrix six*/ + data_u8[BNO055_SOFT_IRON_CALIB_6_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_6_LSB], + BNO055_SIC_MATRIX_6_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_6_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_6_MSB], + BNO055_SIC_MATRIX_6_LSB); + sic_matrix->sic_6 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_6_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_6_LSB])); + + /*soft iron calibration matrix seven*/ + data_u8[BNO055_SOFT_IRON_CALIB_7_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_7_LSB], + BNO055_SIC_MATRIX_7_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_7_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_7_MSB], + BNO055_SIC_MATRIX_7_LSB); + sic_matrix->sic_7 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_7_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_7_LSB])); + + /*soft iron calibration matrix eight*/ + data_u8[BNO055_SOFT_IRON_CALIB_8_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_8_LSB], + BNO055_SIC_MATRIX_8_LSB); + data_u8[BNO055_SOFT_IRON_CALIB_8_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SOFT_IRON_CALIB_8_MSB], + BNO055_SIC_MATRIX_8_LSB); + sic_matrix->sic_8 = (s16)((((s32) + (s8)(data_u8[BNO055_SOFT_IRON_CALIB_8_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SOFT_IRON_CALIB_8_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to write soft iron calibration matrix + * from the register 0x43 to 0x53 it is a 18 bytes of data + * + * @param sic_matrix : The value of soft iron calibration matrix + * + * sic_matrix | result + * --------------------|---------------------------------- + * sic_0 | soft iron calibration matrix zero + * sic_1 | soft iron calibration matrix one + * sic_2 | soft iron calibration matrix two + * sic_3 | soft iron calibration matrix three + * sic_4 | soft iron calibration matrix four + * sic_5 | soft iron calibration matrix five + * sic_6 | soft iron calibration matrix six + * sic_7 | soft iron calibration matrix seven + * sic_8 | soft iron calibration matrix eight + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note : Each soft iron calibration matrix range from -32768 to +32767 + */ +BNO055_RETURN_FUNCTION_TYPE bno055_write_sic_matrix( +struct bno055_sic_matrix_t *sic_matrix) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data1_u8r = BNO055_INIT_VALUE; +u8 data2_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* write soft iron calibration + matrix zero value*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_0_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_0 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_0_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_0_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_0_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_0 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_0_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_0_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix one value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_1_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_1 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_1_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_1_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_1_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_1 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_1_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_1_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix two value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_2_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_2 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_2_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_2_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_2_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_2 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_2_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_2_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix three value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_3_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_3 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_3_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_3_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_3_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_3 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_3_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_3_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix four value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_4_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_4 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_4_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_4_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_4_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_4 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_4_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_4_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix five value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_5_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_5 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_5_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_5_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_5_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_5 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_5_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_5_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix six value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_6_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_6 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_6_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_6_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_6_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_6 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_6_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_6_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix seven value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_7_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_7 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_7_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_7_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_7_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_7 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_7_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_7_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write soft iron calibration + matrix eight value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_8_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_8 + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_8_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_8_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_8_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (sic_matrix->sic_8 >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_SIC_MATRIX_8_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_SIC_MATRIX_8_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API is used to read accel offset and accel radius + * offset form register 0x55 to 0x5A and radius form 0x67 and 0x68 + * + * @param accel_offset : The value of accel offset and radius + * + * bno055_accel_offset_t | result + * ------------------- | ---------------- + * x | accel offset x + * y | accel offset y + * z | accel offset z + * r | accel offset r + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the accel offset varies based on + * the G-range of accel sensor. + * + * accel G range | offset range + * --------------- | -------------- + * BNO055_ACCEL_RANGE_2G | +/-2000 + * BNO055_ACCEL_RANGE_4G | +/-4000 + * BNO055_ACCEL_RANGE_8G | +/-8000 + * BNO055_ACCEL_RANGE_16G | +/-16000 + * + * accel G range can be configured by using the + * bno055_set_accel_range() API + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_accel_offset( +struct bno055_accel_offset_t *accel_offset) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the accel offset values + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] - offset x->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] - offset x->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] - offset y->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] - offset y->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] - offset z->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] - offset z->MSB + */ + u8 data_u8[BNO055_ACCEL_OFFSET_ARRAY] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel offset is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read accel offset value it is six bytes of data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_X_LSB_REG, + data_u8, BNO055_ACCEL_OFFSET_ARRAY); + if (com_rslt == BNO055_SUCCESS) { + /* Read accel x offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB], + BNO055_ACCEL_OFFSET_X_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB], + BNO055_ACCEL_OFFSET_X_MSB); + accel_offset->x = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB])); + + /* Read accel y offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB], + BNO055_ACCEL_OFFSET_Y_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB], + BNO055_ACCEL_OFFSET_Y_MSB); + accel_offset->y = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB])); + + /* Read accel z offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB], + BNO055_ACCEL_OFFSET_Z_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB], + BNO055_ACCEL_OFFSET_Z_MSB); + accel_offset->z = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB])); + + /* Read accel radius value + it is two bytes of data*/ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RADIUS_LSB_REG, + data_u8, + BNO055_LSB_MSB_READ_LENGTH); + /* Array holding the accel radius values + data_u8[BNO055_OFFSET_RADIUS_LSB] - radius->LSB + data_u8[BNO055_OFFSET_RADIUS_MSB] - radius->MSB + */ + if (com_rslt == BNO055_SUCCESS) { + data_u8[BNO055_OFFSET_RADIUS_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_OFFSET_RADIUS_LSB], + BNO055_ACCEL_RADIUS_LSB); + data_u8[BNO055_OFFSET_RADIUS_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_OFFSET_RADIUS_MSB], + BNO055_ACCEL_RADIUS_MSB); + accel_offset->r = (s16)((((s32)(s8) + (data_u8[BNO055_OFFSET_RADIUS_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_OFFSET_RADIUS_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to write accel offset and accel radius + * offset form register 0x55 to 0x5A and radius form 0x67 and 0x68 + * + * @param accel_offset : The value of accel offset and radius + * + * bno055_accel_offset_t | result + * ------------------- | ---------------- + * x | accel offset x + * y | accel offset y + * z | accel offset z + * r | accel offset r + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the accel offset varies based on + * the G-range of accel sensor. + * + * accel G range | offset range + * --------------- | -------------- + * BNO055_ACCEL_RANGE_2G | +/-2000 + * BNO055_ACCEL_RANGE_4G | +/-4000 + * BNO055_ACCEL_RANGE_8G | +/-8000 + * BNO055_ACCEL_RANGE_16G | +/-16000 + * + * accel G range can be configured by using the + * bno055_set_accel_range() API + */ +BNO055_RETURN_FUNCTION_TYPE bno055_write_accel_offset( +struct bno055_accel_offset_t *accel_offset) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data1_u8r = BNO055_INIT_VALUE; +u8 data2_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* write accel offset x value*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->x + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_X_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->x >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_X_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write accel offset y value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->y + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_Y_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->y >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_Y_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + /* write accel offset z value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->z + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_Z_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->z >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_OFFSET_Z_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /*write accel radius value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RADIUS_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->r + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_RADIUS_LSB, + data1_u8r); + com_rslt = + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RADIUS_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RADIUS_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (accel_offset->r >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_ACCEL_RADIUS_MSB, + data1_u8r); + com_rslt = + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RADIUS_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} + +/*! + * @brief This API is used to read mag offset + * offset form register 0x69 to 0x6A + * + * @param mag_offset : The value of mag offset and radius + * + * bno055_mag_offset_t | result + * ------------------- | ---------------- + * x | mag offset x + * y | mag offset y + * z | mag offset z + * r | mag radius r + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the magnetometer offset is +/-6400 in LSB + */ + +BNO055_RETURN_FUNCTION_TYPE bno055_read_mag_offset( +struct bno055_mag_offset_t *mag_offset) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the mag offset values + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] - offset x->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] - offset x->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] - offset y->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] - offset y->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] - offset z->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] - offset z->MSB + */ + u8 data_u8[BNO055_MAG_OFFSET_ARRAY] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, mag offset is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read mag offset value it the six bytes of data */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_X_LSB_REG, + data_u8, BNO055_MAG_OFFSET_ARRAY); + if (com_rslt == BNO055_SUCCESS) { + /* Read mag x offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB], + BNO055_MAG_OFFSET_X_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB], + BNO055_MAG_OFFSET_X_MSB); + mag_offset->x = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB])); + + /* Read mag y offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB], + BNO055_MAG_OFFSET_Y_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB], + BNO055_MAG_OFFSET_Y_MSB); + mag_offset->y = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB])); + + /* Read mag z offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB], + BNO055_MAG_OFFSET_Z_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB], + BNO055_MAG_OFFSET_Z_MSB); + mag_offset->z = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) + | (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB])); + + /* Read mag radius value + it the two bytes of data */ + com_rslt += p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_RADIUS_LSB_REG, + data_u8, + BNO055_LSB_MSB_READ_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Array holding the mag radius values + data_u8[BNO055_OFFSET_RADIUS_LSB] - + radius->LSB + data_u8[BNO055_OFFSET_RADIUS_MSB] - + radius->MSB + */ + data_u8[BNO055_OFFSET_RADIUS_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_OFFSET_RADIUS_LSB], + BNO055_MAG_RADIUS_LSB); + data_u8[BNO055_OFFSET_RADIUS_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_OFFSET_RADIUS_MSB], + BNO055_MAG_RADIUS_MSB); + mag_offset->r = (s16)((((s32)(s8) + (data_u8[BNO055_OFFSET_RADIUS_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_OFFSET_RADIUS_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} + +/*! + * @brief This API is used to read mag offset + * offset form register 0x69 to 0x6A + * + * @param mag_offset : The value of mag offset and radius + * + * bno055_mag_offset_t | result + * ------------------- | ---------------- + * x | mag offset x + * y | mag offset y + * z | mag offset z + * r | mag radius r + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the magnetometer offset is +/-6400 in LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_write_mag_offset( +struct bno055_mag_offset_t *mag_offset) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data1_u8r = BNO055_INIT_VALUE; +u8 data2_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* write Mag offset x value*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->x + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_X_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->x >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_X_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write Mag offset y value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->y & + BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_Y_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->y >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_Y_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + /* write Mag offset z value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->z & + BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_Z_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->z >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_OFFSET_Z_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write Mag radius value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_RADIUS_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->r & + BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_RADIUS_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_RADIUS_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_RADIUS_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (mag_offset->r >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_MAG_RADIUS_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_RADIUS_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API is used to read gyro offset + * offset form register 0x61 to 0x66 + * + * @param gyro_offset : The value of gyro offset + * + * bno055_gyro_offset_t | result + * ------------------- | ---------------- + * x | gyro offset x + * y | gyro offset y + * z | gyro offset z + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the gyro offset varies based on + * the range of gyro sensor + * + * gyro G range | offset range + * -------------------- | ------------ + * BNO055_GYRO_RANGE_2000DPS | +/-32000 + * BNO055_GYRO_RANGE_1000DPS | +/-16000 + * BNO055_GYRO_RANGE_500DPS | +/-8000 + * BNO055_GYRO_RANGE_250DPS | +/-4000 + * BNO055_GYRO_RANGE_125DPS | +/-2000 + * + * Gyro range can be configured by using the + * bno055_set_gyro_range() API + */ +BNO055_RETURN_FUNCTION_TYPE bno055_read_gyro_offset( +struct bno055_gyro_offset_t *gyro_offset) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + /* Array holding the gyro offset values + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] - offset x->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] - offset x->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] - offset y->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] - offset y->MSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] - offset z->LSB + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] - offset z->MSB + */ + u8 data_u8[BNO055_GYRO_OFFSET_ARRAY] = { + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE, + BNO055_INIT_VALUE, BNO055_INIT_VALUE}; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro offset is + available in the page zero*/ + if (p_bno055->page_id != BNO055_PAGE_ZERO) + /* Write the page zero*/ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ZERO); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ZERO)) { + /* Read gyro offset value it the six bytes of data*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_X_LSB_REG, + data_u8, BNO055_GYRO_OFFSET_ARRAY); + if (com_rslt == BNO055_SUCCESS) { + /* Read gyro x offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB], + BNO055_GYRO_OFFSET_X_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB], + BNO055_GYRO_OFFSET_X_MSB); + gyro_offset->x = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_X_LSB])); + + /* Read gyro y offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB], + BNO055_GYRO_OFFSET_Y_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB], + BNO055_GYRO_OFFSET_Y_MSB); + gyro_offset->y = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_Y_LSB])); + + /* Read gyro z offset value*/ + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB], + BNO055_GYRO_OFFSET_Z_LSB); + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB] = + BNO055_GET_BITSLICE( + data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB], + BNO055_GYRO_OFFSET_Z_MSB); + gyro_offset->z = (s16)((((s32)(s8) + (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_MSB])) << + (BNO055_SHIFT_EIGHT_BITS)) | + (data_u8[BNO055_SENSOR_OFFSET_DATA_Z_LSB])); + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API is used to read gyro offset + * offset form register 0x61 to 0x66 + * + * @param gyro_offset : The value of gyro offset + * + * bno055_gyro_offset_t | result + * ------------------- | ---------------- + * x | gyro offset x + * y | gyro offset y + * z | gyro offset z + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The range of the gyro offset varies based on + * the range of gyro sensor + * + * gyro G range | offset range + * -------------------- | ------------ + * BNO055_GYRO_RANGE_2000DPS | +/-32000 + * BNO055_GYRO_RANGE_1000DPS | +/-16000 + * BNO055_GYRO_RANGE_500DPS | +/-8000 + * BNO055_GYRO_RANGE_250DPS | +/-4000 + * BNO055_GYRO_RANGE_125DPS | +/-2000 + * + * Gyro range can be configured by using the + * bno055_set_gyro_range() API + */ +BNO055_RETURN_FUNCTION_TYPE bno055_write_gyro_offset( +struct bno055_gyro_offset_t *gyro_offset) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data1_u8r = BNO055_INIT_VALUE; +u8 data2_u8r = BNO055_INIT_VALUE; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* write gryo offset x value*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->x + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_X_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_X_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->x >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_X_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_X_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + /* write gryo offset y value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->y + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_Y_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Y_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->y >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_Y_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Y_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + /* write gryo offset z value*/ + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->z + & BNO055_SIC_HEX_0_0_F_F_DATA)); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_Z_LSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Z_LSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + + com_rslt += + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data1_u8r = ((s8) + (gyro_offset->z >> + BNO055_SHIFT_EIGHT_BITS) + & BNO055_SIC_HEX_0_0_F_F_DATA); + data2_u8r = + BNO055_SET_BITSLICE(data2_u8r, + BNO055_GYRO_OFFSET_Z_MSB, + data1_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_OFFSET_Z_MSB_REG, + &data2_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/********************************************************/ + /************** PAGE1 Functions *********************/ +/********************************************************/ +/*! + * @brief This API used to read the accel range + * from page one register from 0x08 bit 0 and 1 + * + * @param accel_range_u8 : The value of accel range + * accel_range_u8 | result + * ----------------- | -------------- + * 0x00 | BNO055_ACCEL_RANGE_2G + * 0x01 | BNO055_ACCEL_RANGE_4G + * 0x02 | BNO055_ACCEL_RANGE_8G + * 0x03 | BNO055_ACCEL_RANGE_16G + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_range( +u8 *accel_range_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel g range */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RANGE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_range_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_RANGE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel range + * from page one register from 0x08 bit 0 and 1 + * + * @param accel_range_u8 : The value of accel range + * + * accel_range_u8 | result + * ----------------- | -------------- + * 0x00 | BNO055_ACCEL_RANGE_2G + * 0x01 | BNO055_ACCEL_RANGE_4G + * 0x02 | BNO055_ACCEL_RANGE_8G + * 0x03 | BNO055_ACCEL_RANGE_16G + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_range( +u8 accel_range_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (accel_range_u8 < BNO055_ACCEL_RANGE) { + /* Write the value of accel range*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RANGE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_RANGE, + accel_range_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_RANGE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel bandwidth + * from page one register from 0x08 bit 2 to 4 + * + * @param accel_bw_u8 : The value of accel bandwidth + * + * accel_bw_u8 | result + * ----------------- | --------------- + * 0x00 | BNO055_ACCEL_BW_7_81HZ + * 0x01 | BNO055_ACCEL_BW_15_63HZ + * 0x02 | BNO055_ACCEL_BW_31_25HZ + * 0x03 | BNO055_ACCEL_BW_62_5HZ + * 0x04 | BNO055_ACCEL_BW_125HZ + * 0x05 | BNO055_ACCEL_BW_250HZ + * 0x06 | BNO055_ACCEL_BW_500HZ + * 0x07 | BNO055_ACCEL_BW_1000HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_bw( +u8 *accel_bw_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel bandwidth is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel bandwidth */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_BW_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_bw_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_BW); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel bandwidth + * from page one register from 0x08 bit 2 to 4 + * + * @param accel_bw_u8 : The value of accel bandwidth + * + * accel_bw_u8 | result + * ----------------- | --------------- + * 0x00 | BNO055_ACCEL_BW_7_81HZ + * 0x01 | BNO055_ACCEL_BW_15_63HZ + * 0x02 | BNO055_ACCEL_BW_31_25HZ + * 0x03 | BNO055_ACCEL_BW_62_5HZ + * 0x04 | BNO055_ACCEL_BW_125HZ + * 0x05 | BNO055_ACCEL_BW_250HZ + * 0x06 | BNO055_ACCEL_BW_500HZ + * 0x07 | BNO055_ACCEL_BW_1000HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_bw( +u8 accel_bw_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (accel_bw_u8 < + BNO055_ACCEL_GYRO_BW_RANGE) { + /* Write the accel */ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_BW_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, BNO055_ACCEL_BW, + accel_bw_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_BW_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel power mode + * from page one register from 0x08 bit 5 to 7 + * + * @param accel_power_mode_u8 : The value of accel power mode + * accel_power_mode_u8 | result + * ----------------- | ------------- + * 0x00 | BNO055_ACCEL_NORMAL + * 0x01 | BNO055_ACCEL_SUSPEND + * 0x02 | BNO055_ACCEL_LOWPOWER_1 + * 0x03 | BNO055_ACCEL_STANDBY + * 0x04 | BNO055_ACCEL_LOWPOWER_2 + * 0x05 | BNO055_ACCEL_DEEPSUSPEND + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_power_mode( +u8 *accel_power_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel power mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel bandwidth */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_power_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_POWER_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel power mode + * from page one register from 0x08 bit 5 to 7 + * + * @param accel_power_mode_u8 : The value of accel power mode + * accel_power_mode_u8 | result + * ----------------- | ------------- + * 0x00 | BNO055_ACCEL_NORMAL + * 0x01 | BNO055_ACCEL_SUSPEND + * 0x02 | BNO055_ACCEL_LOWPOWER_1 + * 0x03 | BNO055_ACCEL_STANDBY + * 0x04 | BNO055_ACCEL_LOWPOWER_2 + * 0x05 | BNO055_ACCEL_DEEPSUSPEND + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_power_mode( +u8 accel_power_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (accel_power_mode_u8 < + BNO055_ACCEL_POWER_MODE_RANGE) { + /* Write the value of accel bandwidth*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_POWER_MODE, + accel_power_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the mag output data rate + * from page one register from 0x09 bit 0 to 2 + * + * @param mag_data_output_rate_u8 : The value of mag output data rate + * + * mag_data_output_rate_u8 | result + * ---------------------- |---------------------- + * 0x00 | MAG_DATA_OUTPUT_RATE_2HZ + * 0x01 | MAG_DATA_OUTPUT_RATE_6HZ + * 0x02 | MAG_DATA_OUTPUT_RATE_8HZ + * 0x03 | MAG_DATA_OUTPUT_RATE_10HZ + * 0x04 | MAG_DATA_OUTPUT_RATE_15HZ + * 0x05 | MAG_DATA_OUTPUT_RATE_20HZ + * 0x06 | MAG_DATA_OUTPUT_RATE_25HZ + * 0x07 | MAG_DATA_OUTPUT_RATE_30HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_data_output_rate( +u8 *mag_data_output_rate_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, output data rate + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the mag output data rate*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_OUTPUT_RATE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *mag_data_output_rate_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_DATA_OUTPUT_RATE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the mag output data rate + * from page one register from 0x09 bit 0 to 2 + * + * @param mag_data_output_rate_u8 : The value of mag output data rate + * + * mag_data_output_rate_u8 | result + * ---------------------- |---------------------- + * 0x00 | MAG_DATA_OUTPUT_RATE_2HZ + * 0x01 | MAG_DATA_OUTPUT_RATE_6HZ + * 0x02 | MAG_DATA_OUTPUT_RATE_8HZ + * 0x03 | MAG_DATA_OUTPUT_RATE_10HZ + * 0x04 | MAG_DATA_OUTPUT_RATE_15HZ + * 0x05 | MAG_DATA_OUTPUT_RATE_20HZ + * 0x06 | MAG_DATA_OUTPUT_RATE_25HZ + * 0x07 | MAG_DATA_OUTPUT_RATE_30HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_mag_data_output_rate( +u8 mag_data_output_rate_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (mag_data_output_rate_u8 + < BNO055_MAG_OUTPUT_RANGE) { + /* Write the value of + mag output data rate*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_OUTPUT_RATE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_MAG_DATA_OUTPUT_RATE, + mag_data_output_rate_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_DATA_OUTPUT_RATE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { +com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the mag operation mode + * from page one register from 0x09 bit 3 to 4 + * + * @param mag_operation_mode_u8 : The value of mag operation mode + * + * mag_operation_mode_u8 | result + * ------------------------- |-------------------------- + * 0x00 | MAG_OPR_MODE_LOWPOWER + * 0x01 | MAG_OPR_MODE_REGULAR + * 0x02 | MAG_OPR_MODE_ENHANCED_REGULAR + * 0x03 | MAG_OPR_MODE_HIGH_ACCURACY + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_operation_mode( +u8 *mag_operation_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, mag operation mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of mag operation mode*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OPERATION_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *mag_operation_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_OPERATION_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the mag operation mode + * from page one register from 0x09 bit 3 to 4 + * + * @param mag_operation_mode_u8 : The value of mag operation mode + * + * mag_operation_mode_u8 | result + * ------------------------- |-------------------------- + * 0x00 | MAG_OPR_MODE_LOWPOWER + * 0x01 | MAG_OPR_MODE_REGULAR + * 0x02 | MAG_OPR_MODE_ENHANCED_REGULAR + * 0x03 | MAG_OPR_MODE_HIGH_ACCURACY + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_mag_operation_mode( +u8 mag_operation_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (mag_operation_mode_u8 + < BNO055_MAG_OPR_MODE_RANGE) { + /* Write the value + of mag operation mode*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_MAG_OPERATION_MODE, + mag_operation_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_OPERATION_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the mag power mode + * from page one register from 0x09 bit 4 to 6 + * + * @param mag_power_mode_u8 : The value of mag power mode + * + * mag_power_mode_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_MAG_POWER_MODE_NORMAL + * 0x01 | BNO055_MAG_POWER_MODE_SLEEP + * 0x02 | BNO055_MAG_POWER_MODE_SUSPEND + * 0x03 | BNO055_MAG_POWER_MODE_FORCE_MODE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_power_mode( +u8 *mag_power_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, mag power mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of mag power mode */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *mag_power_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_POWER_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the mag power mode + * from page one register from 0x09 bit 4 to 6 + * + * @param mag_power_mode_u8 : The value of mag power mode + * + * mag_power_mode_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_MAG_POWER_MODE_NORMAL + * 0x01 | BNO055_MAG_POWER_MODE_SLEEP + * 0x02 | BNO055_MAG_POWER_MODE_SUSPEND + * 0x03 | BNO055_MAG_POWER_MODE_FORCE_MODE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_mag_power_mode( +u8 mag_power_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode( + BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (mag_power_mode_u8 < + BNO055_MAG_POWER_MODE_RANGE) { + /* Write the value of mag power mode*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_MAG_POWER_MODE, + mag_power_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { + com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro range + * from page one register from 0x0A bit 0 to 3 + * + * @param gyro_range_u8 : The value of gyro range + * + * gyro_range_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_GYRO_RANGE_2000DPS + * 0x01 | BNO055_GYRO_RANGE_1000DPS + * 0x02 | BNO055_GYRO_RANGE_500DPS + * 0x03 | BNO055_GYRO_RANGE_250DPS + * 0x04 | BNO055_GYRO_RANGE_125DPS + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_range( +u8 *gyro_range_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro range */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_RANGE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_range_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_RANGE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro range + * from page one register from 0x0A bit 0 to 3 + * + * @param gyro_range_u8 : The value of gyro range + * + * gyro_range_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_GYRO_RANGE_2000DPS + * 0x01 | BNO055_GYRO_RANGE_1000DPS + * 0x02 | BNO055_GYRO_RANGE_500DPS + * 0x03 | BNO055_GYRO_RANGE_250DPS + * 0x04 | BNO055_GYRO_RANGE_125DPS + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_range( +u8 gyro_range_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (gyro_range_u8 < BNO055_GYRO_RANGE) { + /* Write the value of gyro range*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_RANGE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_RANGE, + gyro_range_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_RANGE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro bandwidth + * from page one register from 0x0A bit 3 to 5 + * + * @param gyro_bw_u8 : The value of gyro bandwidth + * + * gyro_bw_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_GYRO_BW_523HZ + * 0x01 | BNO055_GYRO_BW_230HZ + * 0x02 | BNO055_GYRO_BW_116HZ + * 0x03 | BNO055_GYRO_BW_47HZ + * 0x04 | BNO055_GYRO_BW_23HZ + * 0x05 | BNO055_GYRO_BW_12HZ + * 0x06 | BNO055_GYRO_BW_64HZ + * 0x07 | BNO055_GYRO_BW_32HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_bw( +u8 *gyro_bw_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro bandwidth is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_BW_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_bw_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_BW); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro bandwidth + * from page one register from 0x0A bit 3 to 5 + * + * @param gyro_bw_u8 : The value of gyro bandwidth + * + * gyro_bw_u8 | result + * --------------------|----------------- + * 0x00 | BNO055_GYRO_BW_523HZ + * 0x01 | BNO055_GYRO_BW_230HZ + * 0x02 | BNO055_GYRO_BW_116HZ + * 0x03 | BNO055_GYRO_BW_47HZ + * 0x04 | BNO055_GYRO_BW_23HZ + * 0x05 | BNO055_GYRO_BW_12HZ + * 0x06 | BNO055_GYRO_BW_64HZ + * 0x07 | BNO055_GYRO_BW_32HZ + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_bw( +u8 gyro_bw_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 gyro_opmode = BNO055_INIT_VALUE; +u8 gyro_auto_sleep_durn = BNO055_INIT_VALUE; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of gyro bandwidth */ + if ((gyro_bw_u8 == BNO055_INIT_VALUE || + gyro_bw_u8 > BNO055_INIT_VALUE) && + gyro_bw_u8 < BNO055_ACCEL_GYRO_BW_RANGE) { + switch (gyro_bw_u8) { + case BNO055_GYRO_BW_523HZ: + gyro_bw_u8 = BNO055_GYRO_BW_523HZ; + break; + case BNO055_GYRO_BW_230HZ: + gyro_bw_u8 = BNO055_GYRO_BW_230HZ; + break; + case BNO055_GYRO_BW_116HZ: + gyro_bw_u8 = BNO055_GYRO_BW_116HZ; + break; + case BNO055_GYRO_BW_47HZ: + gyro_bw_u8 = BNO055_GYRO_BW_47HZ; + break; + case BNO055_GYRO_BW_23HZ: + gyro_bw_u8 = BNO055_GYRO_BW_23HZ; + break; + case BNO055_GYRO_BW_12HZ: + gyro_bw_u8 = BNO055_GYRO_BW_12HZ; + break; + case BNO055_GYRO_BW_64HZ: + gyro_bw_u8 = BNO055_GYRO_BW_64HZ; + break; + case BNO055_GYRO_BW_32HZ: + gyro_bw_u8 = BNO055_GYRO_BW_32HZ; + break; + default: + break; + } + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_BW_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_BW, + gyro_bw_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_BW_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + com_rslt = bno055_get_gyro_power_mode + (&gyro_opmode); + if (com_rslt == BNO055_SUCCESS) { + if (gyro_opmode == + BNO055_GYRO_POWER_MODE_ADVANCE_POWERSAVE) { + com_rslt += + bno055_get_gyro_auto_sleep_durn + (&gyro_auto_sleep_durn); + if (com_rslt == BNO055_SUCCESS) { + com_rslt += + bno055_gyro_set_auto_sleep_durn + (gyro_auto_sleep_durn, + gyro_bw_u8); + } + } + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { +com_rslt = BNO055_ERROR; +} +} else { +com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro power mode + * from page one register from 0x0B bit 0 to 2 + * + * @param gyro_power_mode_u8 : The value of gyro power mode + * + * gyro_power_mode_u8 | result + * ----------------------|---------------------------- + * 0x00 | GYRO_OPR_MODE_NORMAL + * 0x01 | GYRO_OPR_MODE_FASTPOWERUP + * 0x02 | GYRO_OPR_MODE_DEEPSUSPEND + * 0x03 | GYRO_OPR_MODE_SUSPEND + * 0x04 | GYRO_OPR_MODE_ADVANCE_POWERSAVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_power_mode( +u8 *gyro_power_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro power mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Write the value of gyro power mode*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_POWER_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_power_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_POWER_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro power mode + * from page one register from 0x0B bit 0 to 2 + * + * @param gyro_power_mode_u8 : The value of gyro power mode + * + * gyro_power_mode_u8 | result + * ----------------------|---------------------------- + * 0x00 | GYRO_OPR_MODE_NORMAL + * 0x01 | GYRO_OPR_MODE_FASTPOWERUP + * 0x02 | GYRO_OPR_MODE_DEEPSUSPEND + * 0x03 | GYRO_OPR_MODE_SUSPEND + * 0x04 | GYRO_OPR_MODE_ADVANCE_POWERSAVE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_power_mode( +u8 gyro_power_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 gyro_auto_sleep_durn = BNO055_INIT_VALUE; +u8 gyro_bw_u8 = BNO055_INIT_VALUE; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of power mode*/ + if ((gyro_power_mode_u8 == BNO055_INIT_VALUE || + gyro_power_mode_u8 > BNO055_INIT_VALUE) && + gyro_power_mode_u8 < BNO055_GYRO_RANGE) { + switch (gyro_power_mode_u8) { + case BNO055_GYRO_POWER_MODE_NORMAL: + gyro_power_mode_u8 = + BNO055_GYRO_POWER_MODE_NORMAL; + break; + case BNO055_GYRO_POWER_MODE_FASTPOWERUP: + gyro_power_mode_u8 = + BNO055_GYRO_POWER_MODE_FASTPOWERUP; + break; + case BNO055_GYRO_POWER_MODE_DEEPSUSPEND: + gyro_power_mode_u8 = + BNO055_GYRO_POWER_MODE_DEEPSUSPEND; + break; + case BNO055_GYRO_POWER_MODE_SUSPEND: + gyro_power_mode_u8 = + BNO055_GYRO_POWER_MODE_SUSPEND; + break; + case BNO055_GYRO_POWER_MODE_ADVANCE_POWERSAVE: + com_rslt = bno055_get_gyro_bw + (&gyro_bw_u8); + com_rslt += bno055_get_gyro_auto_sleep_durn + (&gyro_auto_sleep_durn); + if (com_rslt == BNO055_SUCCESS) + bno055_gyro_set_auto_sleep_durn + (gyro_auto_sleep_durn, + gyro_bw_u8); + com_rslt += + bno055_write_page_id(BNO055_PAGE_ONE); + gyro_power_mode_u8 = + BNO055_GYRO_POWER_MODE_ADVANCE_POWERSAVE; + break; + default: + break; + } + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_POWER_MODE, + gyro_power_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_POWER_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { + com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel sleep mode + * from page one register from 0x0C bit 0 + * + * @param sleep_tmr_u8 : The value of accel sleep mode + * + * sleep_tmr_u8 | result + * ----------------- |------------------------------------ + * 0x00 | enable EventDrivenSampling(EDT) + * 0x01 | enable Equidistant sampling mode(EST) + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_sleep_tmr_mode( +u8 *sleep_tmr_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel sleep mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* read the value of accel sleep mode */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_MODE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sleep_tmr_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_SLEEP_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel sleep mode + * from page one register from 0x0C bit 0 + * + * @param sleep_tmr_u8 : The value of accel sleep mode + * + * sleep_tmr_u8 | result + * ----------------- |------------------------------------ + * 0x00 | enable EventDrivenSampling(EDT) + * 0x01 | enable Equidistant sampling mode(EST) + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_sleep_tmr_mode( +u8 sleep_tmr_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (sleep_tmr_u8 < + BNO055_ACCEL_SLEEP_MODE_RANGE) { + /*Write the value + of accel sleep mode*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_SLEEP_MODE, + sleep_tmr_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel sleep duration + * from page one register from 0x0C bit 1 to 4 + * + * @param sleep_durn_u8 : The value of accel sleep duration + * + * sleep_durn_u8 | result + * ---------------- |----------------------------- + * 0x05 | BNO055_ACCEL_SLEEP_DURN_0_5MS + * 0x06 | BNO055_ACCEL_SLEEP_DURN_1MS + * 0x07 | BNO055_ACCEL_SLEEP_DURN_2MS + * 0x08 | BNO055_ACCEL_SLEEP_DURN_4MS + * 0x09 | BNO055_ACCEL_SLEEP_DURN_6MS + * 0x0A | BNO055_ACCEL_SLEEP_DURN_10MS + * 0x0B | BNO055_ACCEL_SLEEP_DURN_25MS + * 0x0C | BNO055_ACCEL_SLEEP_DURN_50MS + * 0x0D | BNO055_ACCEL_SLEEP_DURN_100MS + * 0x0E | BNO055_ACCEL_SLEEP_DURN_500MS + * 0x0F | BNO055_ACCEL_SLEEP_DURN_1S + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_sleep_durn( +u8 *sleep_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel sleep duration + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel sleep duration */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sleep_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_SLEEP_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel sleep duration + * from page one register from 0x0C bit 1 to 4 + * + * @param sleep_durn_u8 : The value of accel sleep duration + * + * sleep_durn_u8 | result + * ---------------|----------------------------- + * 0x05 | BNO055_ACCEL_SLEEP_DURN_0_5MS + * 0x06 | BNO055_ACCEL_SLEEP_DURN_1MS + * 0x07 | BNO055_ACCEL_SLEEP_DURN_2MS + * 0x08 | BNO055_ACCEL_SLEEP_DURN_4MS + * 0x09 | BNO055_ACCEL_SLEEP_DURN_6MS + * 0x0A | BNO055_ACCEL_SLEEP_DURN_10MS + * 0x0B | BNO055_ACCEL_SLEEP_DURN_25MS + * 0x0C | BNO055_ACCEL_SLEEP_DURN_50MS + * 0x0D | BNO055_ACCEL_SLEEP_DURN_100MS + * 0x0E | BNO055_ACCEL_SLEEP_DURN_500MS + * 0x0F | BNO055_ACCEL_SLEEP_DURN_1S + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_sleep_durn( +u8 sleep_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (sleep_durn_u8 < + BNO055_ACCEL_SLEEP_DURATION_RANGE) { + /* Write the accel + sleep duration*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_SLEEP_DURN, + sleep_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to write the gyro sleep duration + * from page one register from 0x0D bit 0 to 2 + * + * @param sleep_durn_u8 : The value of gyro sleep duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_sleep_durn(u8 *sleep_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the gyro sleep duration */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLEEP_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sleep_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_SLEEP_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro sleep duration + * from page one register from 0x0D bit 0 to 2 + * + * @param sleep_durn_u8 : The value of gyro sleep duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_sleep_durn(u8 sleep_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + if (sleep_durn_u8 < + BNO055_GYRO_AUTO_SLEEP_DURATION_RANGE) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the gyro + sleep duration */ + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_SLEEP_DURN, + sleep_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro auto sleep duration + * from page one register from 0x0D bit 3 to 5 + * + * @param auto_sleep_durn_u8 : The value of gyro auto sleep duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_auto_sleep_durn( +u8 *auto_sleep_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro auto sleep duration */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AUTO_SLEEP_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *auto_sleep_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_AUTO_SLEEP_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro auto sleep duration + * from page one register from 0x0D bit 3 to 5 + * + * @param auto_sleep_durn_u8 : The value of gyro auto sleep duration + * @param bw : The value of gyro bandwidth + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_gyro_set_auto_sleep_durn( +u8 auto_sleep_durn_u8, u8 bw) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 auto_sleep_durn_u8r; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of gyro sleep duration */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AUTO_SLEEP_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (auto_sleep_durn_u8 < + BNO055_GYRO_AUTO_SLEEP_DURATION_RANGE) { + switch (bw) { + case BNO055_GYRO_BW_523HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_4MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_4MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_230HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_4MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_4MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_116HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_4MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_4MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_47HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_5MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_5MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_23HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_10MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_10MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_12HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_20MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_20MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_64HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_10MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_10MS_AUTOSLPDUR; + break; + case BNO055_GYRO_BW_32HZ: + if (auto_sleep_durn_u8 > + BNO055_GYRO_20MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_20MS_AUTOSLPDUR; + break; + default: + if (auto_sleep_durn_u8 > + BNO055_GYRO_4MS_AUTOSLPDUR) + auto_sleep_durn_u8r = + auto_sleep_durn_u8; + else + auto_sleep_durn_u8r = + BNO055_GYRO_4MS_AUTOSLPDUR; + break; + } + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_AUTO_SLEEP_DURN, + auto_sleep_durn_u8r); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AUTO_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_OUT_OF_RANGE; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { +com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the mag sleep mode + * from page one register from 0x0E bit 0 + * + * @param sleep_mode_u8 : The value of mag sleep mode + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_sleep_mode( +u8 *sleep_mode_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,mag sleep mode is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of mag sleep mode*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *sleep_mode_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_SLEEP_MODE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the mag sleep mode + * from page one register from 0x0E bit 0 + * + * @param sleep_mode_u8 : The value of mag sleep mode + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_mag_sleep_mode( +u8 sleep_mode_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value + of mag sleep mode*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_MAG_SLEEP_MODE, + sleep_mode_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_MODE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the mag sleep duration + * from page one register from 0x0E bit 1 to 4 + * + * @param sleep_durn_u8 : The value of mag sleep duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_mag_sleep_durn( +u8 *sleep_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,mag sleep duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of mag sleep duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *sleep_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_MAG_SLEEP_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the mag sleep duration + * from page one register from 0x0E bit 1 to 4 + * + * @param sleep_durn_u8 : The value of mag sleep duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_mag_sleep_durn( +u8 sleep_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + mag sleep duration */ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_MAG_SLEEP_DURN, + sleep_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_MAG_SLEEP_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the gyro anymotion interrupt mask + * from page one register from 0x0F bit 2 + * + * @param gyro_any_motion_u8 : The value of gyro anymotion interrupt mask + * gyro_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro anymotion interrupt + * configure the following settings + * + * Axis: + * bno055_set_gyro_any_motion_axis_enable() + * + * Filter setting: + * bno055_set_gyro_any_motion_filter() + * + * Threshold : + * + * bno055_set_gyro_any_motion_thres() + * + * Slope samples : + * + * bno055_set_gyro_any_motion_slope_samples() + * + * Awake duration : + * + * bno055_set_gyro_any_motion_awake_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_mask_gyro_any_motion( +u8 *gyro_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro anymotion interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_INTR_MASK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro anymotion interrupt mask + * from page one register from 0x0F bit 2 + * + * @param gyro_any_motion_u8 : The value of gyro anymotion interrupt mask + * gyro_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro anymotion interrupt + * configure the following settings + * + * Axis: + * bno055_set_gyro_any_motion_axis_enable() + * + * Filter setting: + * bno055_set_gyro_any_motion_filter() + * + * Threshold : + * + * bno055_set_gyro_any_motion_thres() + * + * Slope samples : + * + * bno055_set_gyro_any_motion_slope_samples() + * + * Awake duration : + * + * bno055_set_gyro_any_motion_awake_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_mask_gyro_any_motion( +u8 gyro_any_motion_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Write the value of gyro anymotion interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_INTR_MASK, + gyro_any_motion_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the gyro highrate interrupt mask + * from page one register from 0x0F bit 3 + * + * @param gyro_highrate_u8 : The value of gyro highrate interrupt mask + * gyro_highrate_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro highrate interrupt + * configure the below settings by using + * the following API + * + * Axis : + * + * bno055_set_gyro_highrate_axis_enable() + * + * Filter : + * + * bno055_set_gyro_highrate_filter() + * + * Threshold : + * + * bno055_get_gyro_highrate_x_thres() + * + * bno055_get_gyro_highrate_y_thres() + * + * bno055_get_gyro_highrate_z_thres() + * + * Hysteresis : + * + * bno055_set_gyro_highrate_x_hyst() + * + * bno055_set_gyro_highrate_y_hyst() + * + * bno055_set_gyro_highrate_z_hyst() + * + * Duration : + * + * bno055_set_gyro_highrate_x_durn() + * + * bno055_set_gyro_highrate_y_durn() + * + * bno055_set_gyro_highrate_z_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_mask_gyro_highrate( +u8 *gyro_highrate_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_INTR_MASK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro highrate interrupt mask + * from page one register from 0x0F bit 3 + * + * @param gyro_highrate_u8 : The value of gyro highrate interrupt mask + * gyro_highrate_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro highrate interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_gyro_highrate_axis_enable() + * + * Filter : + * + * bno055_set_gyro_highrate_filter() + * + * Threshold : + * + * bno055_get_gyro_highrate_x_thres() + * + * bno055_get_gyro_highrate_y_thres() + * + * bno055_get_gyro_highrate_z_thres() + * + * Hysteresis : + * + * bno055_set_gyro_highrate_x_hyst() + * + * bno055_set_gyro_highrate_y_hyst() + * + * bno055_set_gyro_highrate_z_hyst() + * + * Duration : + * + * bno055_set_gyro_highrate_x_durn() + * + * bno055_set_gyro_highrate_y_durn() + * + * bno055_set_gyro_highrate_z_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_mask_gyro_highrate( +u8 gyro_highrate_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of gyro + highrate interrupt mask*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_INTR_MASK, + gyro_highrate_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel highg interrupt mask + * from page one register from 0x0F bit 5 + * + * @param accel_high_g_u8 : The value of accel highg interrupt mask + * accel_high_g_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel highg interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_accel_high_g_axis_enable() + * + * Threshold : + * + * bno055_set_accel_high_g_thres() + * + * Duration : + * + * bno055_set_accel_high_g_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_mask_accel_high_g( +u8 *accel_high_g_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel highg interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_high_g_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_INTR_MASK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel highg interrupt mask + * from page one register from 0x0F bit 5 + * + * @param accel_high_g_u8 : The value of accel highg interrupt mask + * accel_high_g_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel highg interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_accel_high_g_axis_enable() + * + * Threshold : + * + * bno055_set_accel_high_g_thres() + * + * Duration : + * + * bno055_set_accel_high_g_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_mask_accel_high_g( +u8 accel_high_g_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of accel + highg interrupt mask*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_INTR_MASK, + accel_high_g_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel anymotion interrupt mask + * from page one register from 0x0F bit 6 + * + * @param accel_any_motion_u8 : The value of accel anymotion interrupt mask + * accel_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel highg interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_accel_high_g_axis_enable() + * + * Threshold : + * + * bno055_set_accel_high_g_thres() + * + * Duration : + * + * bno055_set_accel_high_g_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_mask_accel_any_motion( +u8 *accel_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* The value of accel anymotion interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_INTR_MASK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel anymotion interrupt mask + * from page one register from 0x0F bit 6 + * + * @param accel_any_motion_u8 : The value of accel anymotion interrupt mask + * accel_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel anymotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Duration: + * + * bno055_set_accel_any_motion_durn() + * + * Threshold: + * + * bno055_set_accel_any_motion_thres() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_mask_accel_any_motion( +u8 accel_any_motion_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Write the value of accel anymotion interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_INTR_MASK, + accel_any_motion_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel nomotion interrupt mask + * from page one register from 0x0F bit 7 + * + * @param accel_nomotion_u8 : The value of accel nomotion interrupt mask + * accel_nomotion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * + * @note While enabling the accel anymotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Duration: + * + * bno055_set_accel_any_motion_durn() + * + * Threshold: + * + * bno055_set_accel_any_motion_thres()) + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_mask_accel_no_motion( +u8 *accel_nomotion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel nomotion interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel nomotion interrupt mask*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_nomotion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_NO_MOTION_INTR_MASK); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel nomotion interrupt mask + * from page one register from 0x0F bit 7 + * + * @param accel_nomotion_u8 : The value of accel nomotion interrupt mask + * accel_nomotion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel nomotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Threshold : + * + * bno055_set_accel_slow_no_motion_thres() + * + * Duration : + * + * bno055_set_accel_slow_no_motion_durn() + * + * Slow/no motion enable: + * + * bno055_set_accel_slow_no_motion_enable() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_mask_accel_no_motion( +u8 accel_nomotion_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel + nomotion interrupt mask is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of accel + nomotion interrupt mask*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_NO_MOTION_INTR_MASK, + accel_nomotion_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_MASK_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the gyro anymotion interrupt + * from page one register from 0x10 bit 2 + * + * @param gyro_any_motion_u8 : The value of gyro anymotion interrupt + * gyro_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro anymotion interrupt + * configure the following settings + * + * Axis: + * bno055_set_gyro_any_motion_axis_enable() + * + * Filter setting: + * bno055_set_gyro_any_motion_filter() + * + * Threshold : + * + * bno055_set_gyro_any_motion_thres() + * + * Slope samples : + * + * bno055_set_gyro_any_motion_slope_samples() + * + * Awake duration : + * + * bno055_set_gyro_any_motion_awake_durn() + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_gyro_any_motion( +u8 *gyro_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro anymotion interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_INTR); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro anymotion interrupt + * from page one register from 0x10 bit 2 + * + * @param gyro_any_motion_u8 : The value of gyro anymotion interrupt + * gyro_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro anymotion interrupt + * configure the following settings + * + * Axis: + * bno055_set_gyro_any_motion_axis_enable() + * + * Filter setting: + * bno055_set_gyro_any_motion_filter() + * + * Threshold : + * + * bno055_set_gyro_any_motion_thres() + * + * Slope samples : + * + * bno055_set_gyro_any_motion_slope_samples() + * + * Awake duration : + * + * bno055_set_gyro_any_motion_awake_durn() + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_gyro_any_motion( +u8 gyro_any_motion_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Write the value of gyro anymotion interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_INTR, + gyro_any_motion_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the gyro highrate interrupt + * from page one register from 0x10 bit 3 + * + * @param gyro_highrate_u8 : The value of gyro highrate interrupt + * gyro_highrate_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro highrate interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_gyro_highrate_axis_enable() + * + * Filter : + * + * bno055_set_gyro_highrate_filter() + * + * Threshold : + * + * bno055_get_gyro_highrate_x_thres() + * + * bno055_get_gyro_highrate_y_thres() + * + * bno055_get_gyro_highrate_z_thres() + * + * Hysteresis : + * + * bno055_set_gyro_highrate_x_hyst() + * + * bno055_set_gyro_highrate_y_hyst() + * + * bno055_set_gyro_highrate_z_hyst() + * + * Duration : + * + * bno055_set_gyro_highrate_x_durn() + * + * bno055_set_gyro_highrate_y_durn() + * + * bno055_set_gyro_highrate_z_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_gyro_highrate( +u8 *gyro_highrate_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_INTR); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro highrate interrupt + * from page one register from 0x10 bit 3 + * + * @param gyro_highrate_u8 : The value of gyro highrate interrupt + * gyro_highrate_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the gyro highrate interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_gyro_highrate_axis_enable() + * + * Filter : + * + * bno055_set_gyro_highrate_filter() + * + * Threshold : + * + * bno055_get_gyro_highrate_x_thres() + * + * bno055_get_gyro_highrate_y_thres() + * + * bno055_get_gyro_highrate_z_thres() + * + * Hysteresis : + * + * bno055_set_gyro_highrate_x_hyst() + * + * bno055_set_gyro_highrate_y_hyst() + * + * bno055_set_gyro_highrate_z_hyst() + * + * Duration : + * + * bno055_set_gyro_highrate_x_durn() + * + * bno055_set_gyro_highrate_y_durn() + * + * bno055_set_gyro_highrate_z_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_gyro_highrate( +u8 gyro_highrate_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of gyro highrate interrupt */ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_INTR, gyro_highrate_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel highg interrupt + * from page one register from 0x10 bit 5 + * + * @param accel_high_g_u8 : The value of accel highg interrupt + * accel_high_g_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel highg interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_accel_high_g_axis_enable() + * + * Threshold : + * + * bno055_set_accel_high_g_thres() + * + * Duration : + * + * bno055_set_accel_high_g_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_accel_high_g( +u8 *accel_high_g_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel highg interrupt*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_high_g_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_INTR); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel highg interrupt + * from page one register from 0x10 bit 5 + * + * @param accel_high_g_u8 : The value of accel highg interrupt + * accel_high_g_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel highg interrupt + * configure the below settings by using + * the following APIs + * + * Axis : + * + * bno055_set_accel_high_g_axis_enable() + * + * Threshold : + * + * bno055_set_accel_high_g_thres() + * + * Duration : + * + * bno055_set_accel_high_g_durn() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_accel_high_g( +u8 accel_high_g_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of accel highg interrupt*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_INTR, + accel_high_g_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel anymotion interrupt + * from page one register from 0x10 bit 6 + * + * @param accel_any_motion_u8 : The value of accel anymotion interrupt + * accel_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel anymotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Duration: + * + * bno055_set_accel_any_motion_durn() + * + * Threshold: + * + * bno055_set_accel_any_motion_thres() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_accel_any_motion( +u8 *accel_any_motion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel anymotion interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_any_motion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_INTR); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel anymotion interrupt + * from page one register from 0x10 bit 6 + * + * @param accel_any_motion_u8 : The value of accel anymotion interrupt + * accel_any_motion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel anymotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Duration: + * + * bno055_set_accel_any_motion_durn() + * + * Threshold: + * + * bno055_set_accel_any_motion_thres() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_accel_any_motion( +u8 accel_any_motion_u8) +{ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel range is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Write the value of accel anymotion interrupt */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_INTR, + accel_any_motion_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel nomotion interrupt + * from page one register from 0x10 bit 6 + * + * @param accel_nomotion_u8 : The value of accel nomotion interrupt + * accel_nomotion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel nomotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Threshold : + * + * bno055_set_accel_slow_no_motion_thres() + * + * Duration : + * + * bno055_set_accel_slow_no_motion_durn() + * + * Slow/no motion enable: + * + * bno055_set_accel_slow_no_motion_enable() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_intr_accel_no_motion( +u8 *accel_nomotion_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel nomotion interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel nomotion interrupt*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_nomotion_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_NO_MOTION_INTR); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel nomotion interrupt + * from page one register from 0x10 bit 6 + * + * @param accel_nomotion_u8 : The value of accel nomotion interrupt + * accel_nomotion_u8 | result + * -------------------- |------------ + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note While enabling the accel nomotion interrupt + * configure the following settings + * + * Axis: + * + * bno055_set_accel_any_motion_no_motion_axis_enable() + * + * Threshold : + * + * bno055_set_accel_slow_no_motion_thres() + * + * Duration : + * + * bno055_set_accel_slow_no_motion_durn() + * + * Slow/no motion enable: + * + * bno055_set_accel_slow_no_motion_enable() + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_intr_accel_no_motion( +u8 accel_nomotion_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, + accel nomotion interrupt is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + accel nomotion interrupt */ + data_u8r = BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_NO_MOTION_INTR, + accel_nomotion_u8); + com_rslt += p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_NO_MOTION_INTR_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to read the accel any motion threshold + * from page one register from 0x11 bit 0 to 7 + * + * @param accel_any_motion_thres_u8 : The value of any motion threshold + * accel_any_motion_thres_u8 | result + * ------------------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel anymotion threshold dependent on the + * range values + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 3.19mg | 1LSB + * 4g | 7.81mg | 1LSB + * 8g | 15.63mg | 1LSB + * 16g | 31.25mg | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_any_motion_thres( +u8 *accel_any_motion_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel any motion threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel any motion threshold */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *accel_any_motion_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel any motion threshold + * from page one register from 0x11 bit 0 to 7 + * + * @param accel_any_motion_thres_u8 : The value of any motion threshold + * accel_any_motion_thres_u8 | result + * ------------------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel anymotion threshold dependent on the + * range values + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 3.19mg | 1LSB + * 4g | 7.81mg | 1LSB + * 8g | 15.63mg | 1LSB + * 16g | 31.25mg | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_any_motion_thres( +u8 accel_any_motion_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + accel any motion threshold*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_THRES, + accel_any_motion_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel anymotion duration + * from page one register from 0x12 bit 0 to 1 + * + * @param accel_any_motion_durn_u8 : The value of accel anymotion duration + * accel_any_motion_durn_u8 | result + * ------------------------- | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_any_motion_durn( +u8 *accel_any_motion_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel anymotion duration */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_DURN_SET_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_any_motion_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_DURN_SET); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel anymotion duration + * from page one register from 0x12 bit 0 to 1 + * + * @param accel_any_motion_durn_u8 : The value of accel anymotion duration + * + * accel_any_motion_durn_u8 | result + * ------------------------- | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_any_motion_durn( +u8 accel_any_motion_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_DURN_SET_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + accel anymotion duration*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_DURN_SET, + accel_any_motion_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_DURN_SET_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel anymotion enable + * from page one register from 0x12 bit 2 to 4 + * + * @param data_u8 : The value of accel anymotion enable + * data_u8 | result + * ------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of accel anymotion axis selection + * channel_u8 | value + * -------------------------- | ---------- + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_X_AXIS | 0 + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS | 1 + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_any_motion_no_motion_axis_enable( +u8 channel_u8, u8 *data_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel anymotion enable is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + switch (channel_u8) { + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_X_AXIS: + /* Read the value of accel anymotion x enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_X_AXIS); + break; + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS: + /* Read the value of accel anymotion y enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_Y_AXIS); + break; + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_Z_AXIS: + /* Read the value of accel anymotion z enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_ANY_MOTION_Z_AXIS); + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel anymotion enable + * from page one register from 0x12 bit 2 to 4 + * + * @param data_u8 : The value of accel anymotion enable + * data_u8 | result + * ------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of accel anymotion axis selection + * channel_u8 | value + * -------------------------- | ---------- + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_X_AXIS | 0 + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS | 1 + * BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_any_motion_no_motion_axis_enable( +u8 channel_u8, u8 data_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + switch (channel_u8) { + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_X_AXIS: + /* Write the value of + accel anymotion x enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_ANY_MOTION_X_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_X_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_Y_AXIS: + /* Write the value of + accel anymotion y enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_ANY_MOTION_Y_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Y_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_ACCEL_ANY_MOTION_NO_MOTION_Z_AXIS: + /* Write the value of + accel anymotion z enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_ACCEL_ANY_MOTION_Z_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_ANY_MOTION_Z_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel highg enable + * from page one register from 0x12 bit 5 to 7 + * + * @param data_u8 : The value of accel highg enable + * data_u8| result + * ------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of accel highg axis selection + * channel_u8 | value + * -------------------------- | ---------- + * BNO055_ACCEL_HIGH_G_X_AXIS | 0 + * BNO055_ACCEL_HIGH_G_Y_AXIS | 1 + * BNO055_ACCEL_HIGH_G_Z_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_high_g_axis_enable( +u8 channel_u8, u8 *data_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg enable is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + switch (channel_u8) { + case BNO055_ACCEL_HIGH_G_X_AXIS: + /* Read the value of accel x highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_X_AXIS); + break; + case BNO055_ACCEL_HIGH_G_Y_AXIS: + /* Read the value of accel y highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_Y_AXIS); + break; + case BNO055_ACCEL_HIGH_G_Z_AXIS: + /* Read the value of accel z highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_Z_AXIS); + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel highg enable + * from page one register from 0x12 bit 5 to 7 + * + * @param data_u8 : The value of accel highg enable + * data_u8| result + * ------------ | ------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of accel highg axis selection + * channel_u8 | value + * -------------------------- | ---------- + * BNO055_ACCEL_HIGH_G_X_AXIS | 0 + * BNO055_ACCEL_HIGH_G_Y_AXIS | 1 + * BNO055_ACCEL_HIGH_G_Z_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_high_g_axis_enable( +u8 channel_u8, u8 data_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + switch (channel_u8) { + case BNO055_ACCEL_HIGH_G_X_AXIS: + /* Write the value of + accel x highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_X_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_X_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_X_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_ACCEL_HIGH_G_Y_AXIS: + /* Write the value of + accel y highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_Y_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Y_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_ACCEL_HIGH_G_Z_AXIS: + /* Write the value of + accel z highg enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_Z_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_Z_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the accel highg duration + * from page one register from 0x13 bit 0 to 7 + * + * @param accel_high_g_durn_u8 : The value of accel highg duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The high-g interrupt trigger delay according + * to [highg duration + 1] * 2 ms + * + * in a range from 2 ms to 512 ms + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_high_g_durn( +u8 *accel_high_g_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel highg duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel highg duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_high_g_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel highg duration + * from page one register from 0x13 bit 0 to 7 + * + * @param accel_high_g_durn_u8 : The value of accel highg duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note The high-g interrupt trigger delay according + * to [highg duration + 1] * 2 ms + * + * in a range from 2 ms to 512 ms + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_high_g_durn( +u8 accel_high_g_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + accel highg duration*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_DURN, + accel_high_g_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the accel highg threshold + * from page one register from 0x14 bit 0 to 7 + * + * @param accel_high_g_thres_u8 : The value of accel highg threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel highg interrupt threshold dependent + * for accel g range + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 7.81mg | 1LSB + * 4g | 15.63mg | 1LSB + * 8g | 31.25mg | 1LSB + * 16g | 62.5mg | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_high_g_thres( +u8 *accel_high_g_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, highg threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of highg threshold */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_high_g_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel highg threshold + * from page one register from 0x14 bit 0 to 7 + * + * @param accel_high_g_thres_u8 : The value of accel highg threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel highg interrupt threshold dependent + * for accel g range + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 7.81mg | 1LSB + * 4g | 15.63mg | 1LSB + * 8g | 31.25mg | 1LSB + * 16g | 62.5mg | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_high_g_thres( +u8 accel_high_g_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Write the value of + accel highg threshold */ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_HIGH_G_THRES, + accel_high_g_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_HIGH_G_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read the accel slownomotion threshold + * from page one register from 0x15 bit 0 to 7 + * + * @param accel_slow_no_motion_thres_u8 : + * The value of accel slownomotion threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel slow no motion interrupt threshold dependent + * for accel g range + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 3.19mg | 1LSB + * 4g | 7.81mg | 1LSB + * 8g | 15.63mg | 1LSB + * 16g | 31.25mg | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_slow_no_motion_thres( +u8 *accel_slow_no_motion_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel slownomotion threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of slownomotion threshold */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_slow_no_motion_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the accel slownomotion threshold + * from page one register from 0x15 bit 0 to 7 + * + * @param accel_slow_no_motion_thres_u8 : + * The value of accel slownomotion threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Accel slow no motion interrupt threshold dependent + * for accel g range + * + * accel_range_u8 | threshold | LSB + * ------------- | ------------- | --------- + * 2g | 3.19mg | 1LSB + * 4g | 7.81mg | 1LSB + * 8g | 15.63mg | 1LSB + * 16g | 31.25mg | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_slow_no_motion_thres( +u8 accel_slow_no_motion_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + slownomotion threshold */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_THRES, + accel_slow_no_motion_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read accel slownomotion enable + * from page one register from 0x16 bit 0 + * + * @param accel_slow_no_motion_en_u8 : The value of accel slownomotion enable + * accel_slow_no_motion_en_u8 | result + * ------------------------ | -------- + * 0x01 | Slow motion + * 0x00 | No motion + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_slow_no_motion_enable( +u8 *accel_slow_no_motion_en_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel slownomotion enable is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of accel slownomotion enable */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_ENABLE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_slow_no_motion_en_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_ENABLE); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write accel slownomotion enable + * from page one register from 0x16 bit 0 + * + * @param accel_slow_no_motion_en_u8 : The value of accel slownomotion enable + * accel_slow_no_motion_en_u8 | result + * ------------------------ | -------- + * 0x01 | Slow motion + * 0x00 | No motion + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_slow_no_motion_enable( +u8 accel_slow_no_motion_en_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_ENABLE_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /* Read the value of + accel slownomotion enable */ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_ENABLE, + accel_slow_no_motion_en_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_ENABLE_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read accel slownomotion duration + * from page one register from 0x16 bit 1 to 6 + * + * @param accel_slow_no_motion_durn_u8 : + * The value of accel slownomotion duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_accel_slow_no_motion_durn( +u8 *accel_slow_no_motion_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, accel slownomotion duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /*read value of accel slownomotion duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *accel_slow_no_motion_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write accel slownomotion duration + * from page one register from 0x16 bit 1 to 6 + * + * @param accel_slow_no_motion_durn_u8 : + * The value of accel slownomotion duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_accel_slow_no_motion_durn( +u8 accel_slow_no_motion_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + /*Write the value of accel + slownomotion duration*/ + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_ACCEL_SLOW_NO_MOTION_DURN, + accel_slow_no_motion_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_ACCEL_SLOW_NO_MOTION_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro anymotion enable + * from page one register from 0x17 bit 0 to 2 + * + * @param data_u8 : The value of gyro anymotion enable + * data_u8 | result + * ----------------- |------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of gyro anymotion axis selection + * channel_u8 | value + * --------------------------- | ---------- + * BNO055_GYRO_ANY_MOTIONX_AXIS | 0 + * BNO055_GYRO_ANY_MOTIONY_AXIS | 1 + * BNO055_GYRO_ANY_MOTIONZ_AXIS | 2 + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_any_motion_axis_enable( +u8 channel_u8, u8 *data_u8) +{ +/* Variable used to return value of +communication routine*/ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion axis is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + switch (channel_u8) { + case BNO055_GYRO_ANY_MOTION_X_AXIS: + /* Read the gyro anymotion x enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_X_AXIS); + break; + case BNO055_GYRO_ANY_MOTION_Y_AXIS: + /* Read the gyro anymotion y enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_Y_AXIS); + break; + case BNO055_GYRO_ANY_MOTION_Z_AXIS: + /* Read the gyro anymotion z enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_Z_AXIS); + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } +} +return com_rslt; +} +/*! + * @brief This API used to write the gyro anymotion enable + * from page one register from 0x17 bit 0 to 2 + * + * @param data_u8 : The value of gyro anymotion enable + * data_u8 | result + * ----------------- |------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of gyro anymotion axis selection + * channel_u8 | value + * --------------------------- | ---------- + * BNO055_GYRO_ANY_MOTIONX_AXIS | 0 + * BNO055_GYRO_ANY_MOTIONY_AXIS | 1 + * BNO055_GYRO_ANY_MOTIONZ_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_any_motion_axis_enable( +u8 channel_u8, u8 data_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + switch (channel_u8) { + case BNO055_GYRO_ANY_MOTION_X_AXIS: + /* Write the gyro + anymotion x enable*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_ANY_MOTION_X_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_GYRO_ANY_MOTION_Y_AXIS: + /* Write the gyro + anymotion y enable*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_ANY_MOTION_Y_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_GYRO_ANY_MOTION_Z_AXIS: + /* Write the gyro + anymotion z enable*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_ANY_MOTION_Z_AXIS, + data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + } + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} else { +com_rslt = BNO055_ERROR; +} +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read the gyro highrate enable + * from page one register from 0x17 bit 3 to 5 + * + * @param data_u8 : The value of gyro highrate enable + * data_u8 | result + * ---------------- |------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of gyro highrate axis selection + * channel_u8 | value + * ------------------------ | ---------- + * BNO055_GYRO_HIGHRATE_X_AXIS | 0 + * BNO055_GYRO_HIGHRATE_Y_AXIS | 1 + * BNO055_GYRO_HIGHRATE_Z_AXIS | 2 + * + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_axis_enable( +u8 channel_u8, u8 *data_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate enable is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + switch (channel_u8) { + case BNO055_GYRO_HIGHRATE_X_AXIS: + /* Read the gyro highrate x enable */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_AXIS); + break; + case BNO055_GYRO_HIGHRATE_Y_AXIS: + /* Read the gyro highrate y enable */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_AXIS); + break; + case BNO055_GYRO_HIGHRATE_Z_AXIS: + /* Read the gyro highrate z enable */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *data_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_AXIS); + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write the gyro highrate enable + * from page one register from 0x17 bit 3 to 5 + * + * @param data_u8 : The value of gyro highrate enable + * data_u8 | result + * ---------------- |------------- + * 0x01 | BNO055_BIT_ENABLE + * 0x00 | BNO055_BIT_DISABLE + * @param channel_u8 : The value of gyro highrate axis selection + * channel_u8 | value + * ------------------------ | ---------- + * BNO055_GYRO_HIGHRATE_X_AXIS | 0 + * BNO055_GYRO_HIGHRATE_Y_AXIS | 1 + * BNO055_GYRO_HIGHRATE_Z_AXIS | 2 + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_axis_enable( +u8 channel_u8, u8 data_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + switch (channel_u8) { + case BNO055_GYRO_HIGHRATE_X_AXIS: + /* Write the value of + gyro highrate x enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_HIGHRATE_X_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_GYRO_HIGHRATE_Y_AXIS: + /* Write the value of + gyro highrate y enable*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE( + data_u8r, + BNO055_GYRO_HIGHRATE_Y_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + case BNO055_GYRO_HIGHRATE_Z_AXIS: + /* Write the value of + gyro highrate z enable*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_AXIS_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = BNO055_SET_BITSLICE + (data_u8r, + BNO055_GYRO_HIGHRATE_Z_AXIS, data_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_AXIS_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + break; + default: + com_rslt = BNO055_OUT_OF_RANGE; + break; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro anymotion filter + * from page one register from 0x17 bit 6 + * + * @param gyro_any_motion_filter_u8 : The value of gyro anymotion filter + * gyro_any_motion_filter_u8 | result + * --------------------------- |------------ + * 0x00 | BNO055_GYRO_FILTERED_CONFIG + * 0x01 | BNO055_GYRO_UNFILTERED_CONFIG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_any_motion_filter( +u8 *gyro_any_motion_filter_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion filter is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro anymotion filter*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_FILTER_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_filter_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_FILTER); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro anymotion filter + * from page one register from 0x17 bit 6 + * + * @param gyro_any_motion_filter_u8 : The value of gyro anymotion filter + * gyro_any_motion_filter_u8 | result + * --------------------------- |------------ + * 0x00 | BNO055_GYRO_FILTERED_CONFIG + * 0x01 | BNO055_GYRO_UNFILTERED_CONFIG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_any_motion_filter( +u8 gyro_any_motion_filter_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro anymotion filter*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_FILTER_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_FILTER, + gyro_any_motion_filter_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_FILTER_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate filter + * from page one register from 0x17 bit 7 + * + * @param gyro_highrate_filter_u8 : The value of gyro highrate filter + * gyro_highrate_filter_u8 | result + * --------------------------- |------------ + * 0x00 | BNO055_GYRO_FILTERED_CONFIG + * 0x01 | BNO055_GYRO_UNFILTERED_CONFIG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_filter( +u8 *gyro_highrate_filter_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate filter is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate filter */ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_FILTER_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_filter_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_FILTER); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate filter + * from page one register from 0x17 bit 7 + * + * @param gyro_highrate_filter_u8 : The value of gyro highrate filter + * gyro_highrate_filter_u8 | result + * --------------------------- |------------ + * 0x00 | BNO055_GYRO_FILTERED_CONFIG + * 0x01 | BNO055_GYRO_UNFILTERED_CONFIG + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_filter( +u8 gyro_highrate_filter_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro highrate filter*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_FILTER_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_FILTER, + gyro_highrate_filter_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_FILTER_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate x threshold + * from page one register from 0x18 bit 0 to 4 + * + * @param gyro_highrate_x_thres_u8 : The value of gyro x highrate threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_x_thres( +u8 *gyro_highrate_x_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate x threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_x_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate x threshold + * from page one register from 0x18 bit 0 to 4 + * + * @param gyro_highrate_x_thres_u8 : The value of gyro x highrate threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_x_thres( +u8 gyro_highrate_x_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro highrate x threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_THRES, + gyro_highrate_x_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate x hysteresis + * from page one register from 0x18 bit 5 to 6 + * + * @param gyro_highrate_x_hyst_u8 : The value of gyro highrate x hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_x_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_x_hyst( +u8 *gyro_highrate_x_hyst_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,gyro highrate x hysteresis is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate x hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_HYST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_x_hyst_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_HYST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate x hysteresis + * from page one register from 0x18 bit 5 to 6 + * + * @param gyro_highrate_x_hyst_u8 : The value of gyro highrate x hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_x_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_x_hyst( +u8 gyro_highrate_x_hyst_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /*Write the value of + gyro highrate x hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_HYST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_HYST, + gyro_highrate_x_hyst_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_HYST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate x duration + * from page one register from 0x19 bit 0 to 7 + * + * @param gyro_highrate_x_durn_u8 : The value of gyro highrate x duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_x_durn_u8)*2.5ms + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_x_durn( +u8 *gyro_highrate_x_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate x duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate x duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_x_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate x duration + * from page one register from 0x19 bit 0 to 7 + * + * @param gyro_highrate_x_durn_u8 : The value of gyro highrate x duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_x_durn_u8)*2.5ms + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_x_durn( +u8 gyro_highrate_x_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro highrate x duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_X_DURN, + gyro_highrate_x_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_X_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read gyro highrate y threshold + * from page one register from 0x1A bit 0 to 4 + * + * @param gyro_highrate_y_thres_u8 : The value of gyro highrate y threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_y_thres( +u8 *gyro_highrate_y_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate y threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate y threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_y_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate y threshold + * from page one register from 0x1A bit 0 to 4 + * + * @param gyro_highrate_y_thres_u8 : The value of gyro highrate y threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_y_thres( +u8 gyro_highrate_y_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro highrate y threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_THRES, + gyro_highrate_y_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate y hysteresis + * from page one register from 0x1A bit 5 to 6 + * + * @param gyro_highrate_y_hyst_u8 : The value of gyro highrate y hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_y_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_y_hyst( +u8 *gyro_highrate_y_hyst_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate y hysteresis is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate y hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_HYST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_y_hyst_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_HYST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate y hysteresis + * from page one register from 0x1A bit 5 to 6 + * + * @param gyro_highrate_y_hyst_u8 : The value of gyro highrate y hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_y_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_y_hyst( +u8 gyro_highrate_y_hyst_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro highrate y hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_HYST_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_HYST, + gyro_highrate_y_hyst_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_HYST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate y duration + * from page one register from 0x1B bit 0 to 7 + * + * @param gyro_highrate_y_durn_u8 : The value of gyro highrate y duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_y_durn_u8)*2.5ms + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_y_durn( +u8 *gyro_highrate_y_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate y duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate y duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_y_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate y duration + * from page one register from 0x1B bit 0 to 7 + * + * @param gyro_highrate_y_durn_u8 : The value of gyro highrate y duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_y_durn_u8)*2.5ms + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_y_durn( +u8 gyro_highrate_y_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro highrate y duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Y_DURN, + gyro_highrate_y_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Y_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read gyro highrate z threshold + * from page one register from 0x1C bit 0 to 4 + * + * @param gyro_highrate_z_thres_u8 : The value of gyro highrate z threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_z_thres( +u8 *gyro_highrate_z_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate z threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate z threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_z_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate z threshold + * from page one register from 0x1C bit 0 to 4 + * + * @param gyro_highrate_z_thres_u8 : The value of gyro highrate z threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate threshold dependent on the + * selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.5dps | 1LSB + * 1000 | 31.25dps | 1LSB + * 500 | 15.625dps | 1LSB + * 125 | 7.8125dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_z_thres( +u8 gyro_highrate_z_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro highrate z threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_THRES, + gyro_highrate_z_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate z hysteresis + * from page one register from 0x1C bit 5 to 6 + * + * @param gyro_highrate_z_hyst_u8 : The value of gyro highrate z hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_z_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_z_hyst( +u8 *gyro_highrate_z_hyst_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate z hysteresis is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate z hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_HYST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_z_hyst_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_HYST); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate z hysteresis + * from page one register from 0x1C bit 5 to 6 + * + * @param gyro_highrate_z_hyst_u8 : The value of gyro highrate z hysteresis + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro high rate hysteresis calculated by + * + * using this (255 + 256 * gyro_highrate_z_hyst_u8) *4 LSB + * + * The high rate value scales with the range setting + * + * gyro_range_u8 | hysteresis | LSB + * ----------------- | ------------- | --------- + * 2000 | 62.26dps | 1LSB + * 1000 | 31.13dps | 1LSB + * 500 | 15.56dps | 1LSB + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_z_hyst( +u8 gyro_highrate_z_hyst_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro highrate z hysteresis*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_HYST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_HYST, + gyro_highrate_z_hyst_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_HYST_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro highrate z duration + * from page one register from 0x1D bit 0 to 7 + * + * @param gyro_highrate_z_durn_u8 : The value of gyro highrate z duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_z_durn_u8)*2.5ms + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_highrate_z_durn( +u8 *gyro_highrate_z_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro highrate z duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro highrate z duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_highrate_z_durn_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro highrate z duration + * from page one register from 0x1D bit 0 to 7 + * + * @param gyro_highrate_z_durn_u8 : The value of gyro highrate z duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro highrate duration calculate by using the formula + * + * (1 + gyro_highrate_z_durn_u8)*2.5ms + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_highrate_z_durn( +u8 gyro_highrate_z_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro highrate z duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_HIGHRATE_Z_DURN, + gyro_highrate_z_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_HIGHRATE_Z_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read gyro anymotion threshold + * from page one register from 0x1E bit 0 to 6 + * + * @param gyro_any_motion_thres_u8 : The value of gyro anymotion threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro anymotion interrupt threshold dependent + * on the selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 1dps | 1LSB + * 1000 | 0.5dps | 1LSB + * 500 | 0.25dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_any_motion_thres( +u8 *gyro_any_motion_thres_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page,gyro anymotion threshold is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro anymotion threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_THRES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_thres_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_THRES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro anymotion threshold + * from page one register from 0x1E bit 0 to 6 + * + * @param gyro_any_motion_thres_u8 : The value of gyro anymotion threshold + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + * @note Gyro anymotion interrupt threshold dependent + * on the selection of gyro range + * + * gyro_range_u8 | threshold | LSB + * ----------------- | ------------- | --------- + * 2000 | 1dps | 1LSB + * 1000 | 0.5dps | 1LSB + * 500 | 0.25dps | 1LSB + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_any_motion_thres( +u8 gyro_any_motion_thres_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +s8 pg_stat_s8 = BNO055_ERROR; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value + of gyro anymotion threshold*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_ANY_MOTION_THRES, + gyro_any_motion_thres_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_ANY_MOTION_THRES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } +} +if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); +return com_rslt; +} +/*! + * @brief This API used to read gyro anymotion slope samples + * from page one register from 0x1F bit 0 to 1 + * + * @param gyro_any_motion_slope_samples_u8 : + * The value of gyro anymotion slope samples + * gyro_any_motion_slope_samples_u8 | result + * ---------------------------------- | ----------- + * 0 | 8 samples + * 1 | 16 samples + * 2 | 32 samples + * 3 | 64 samples + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_any_motion_slope_samples( +u8 *gyro_any_motion_slope_samples_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion slope samples is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /*Read the value of gyro anymotion slope samples*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLOPE_SAMPLES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_any_motion_slope_samples_u8 = + BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_SLOPE_SAMPLES); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro anymotion slope samples + * from page one register from 0x1F bit 0 to 1 + * + * @param gyro_any_motion_slope_samples_u8 : + * The value of gyro anymotion slope samples + * gyro_any_motion_slope_samples_u8 | result + * ---------------------------------- | ----------- + * 0 | 8 samples + * 1 | 16 samples + * 2 | 32 samples + * 3 | 64 samples + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_any_motion_slope_samples( +u8 gyro_any_motion_slope_samples_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; +} else { +/* The write operation effective only if the operation +mode is in config mode, this part of code is checking the +current operation mode and set the config mode */ +stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); +if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of + gyro anymotion slope samples*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLOPE_SAMPLES_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_SLOPE_SAMPLES, + gyro_any_motion_slope_samples_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_SLOPE_SAMPLES_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode of + previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} +/*! + * @brief This API used to read gyro anymotion awake duration + * from page one register from 0x1F bit 2 to 3 + * + * @param gyro_awake_durn_u8 : The value of gyro anymotion awake duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_get_gyro_any_motion_awake_durn( +u8 *gyro_awake_durn_u8) +{ + /* Variable used to return value of + communication routine*/ + BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; + u8 data_u8r = BNO055_INIT_VALUE; + s8 stat_s8 = BNO055_ERROR; + /* Check the struct p_bno055 is empty */ + if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /*condition check for page, gyro anymotion awake duration is + available in the page one*/ + if (p_bno055->page_id != BNO055_PAGE_ONE) + /* Write page as one */ + stat_s8 = bno055_write_page_id(BNO055_PAGE_ONE); + if ((stat_s8 == BNO055_SUCCESS) || + (p_bno055->page_id == BNO055_PAGE_ONE)) { + /* Read the value of gyro anymotion awake duration*/ + com_rslt = p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AWAKE_DURN_REG, + &data_u8r, BNO055_GEN_READ_WRITE_LENGTH); + *gyro_awake_durn_u8 = BNO055_GET_BITSLICE(data_u8r, + BNO055_GYRO_AWAKE_DURN); + } else { + com_rslt = BNO055_ERROR; + } + } + return com_rslt; +} +/*! + * @brief This API used to write gyro anymotion awake duration + * from page one register from 0x1F bit 2 to 3 + * + * @param gyro_awake_durn_u8 : The value of gyro anymotion awake duration + * + * @return results of bus communication function + * @retval 0 -> BNO055_SUCCESS + * @retval 1 -> BNO055_ERROR + * + */ +BNO055_RETURN_FUNCTION_TYPE bno055_set_gyro_any_motion_awake_durn( +u8 gyro_awake_durn_u8) +{ +BNO055_RETURN_FUNCTION_TYPE com_rslt = BNO055_ERROR; +u8 data_u8r = BNO055_INIT_VALUE; +s8 stat_s8 = BNO055_ERROR; +s8 pg_stat_s8 = BNO055_ERROR; +u8 prev_opmode_u8 = BNO055_OPERATION_MODE_CONFIG; +/* Check the struct p_bno055 is empty */ +if (p_bno055 == BNO055_INIT_VALUE) { + return BNO055_E_NULL_PTR; + } else { + /* The write operation effective only if the operation + mode is in config mode, this part of code is checking the + current operation mode and set the config mode */ + stat_s8 = bno055_get_operation_mode(&prev_opmode_u8); + if (stat_s8 == BNO055_SUCCESS) { + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + stat_s8 += bno055_set_operation_mode + (BNO055_OPERATION_MODE_CONFIG); + if (stat_s8 == BNO055_SUCCESS) { + /* Write page as one */ + pg_stat_s8 = bno055_write_page_id( + BNO055_PAGE_ONE); + if (pg_stat_s8 == BNO055_SUCCESS) { + /* Write the value of gyro + anymotion awake duration*/ + com_rslt = + p_bno055->BNO055_BUS_READ_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AWAKE_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + if (com_rslt == BNO055_SUCCESS) { + data_u8r = + BNO055_SET_BITSLICE(data_u8r, + BNO055_GYRO_AWAKE_DURN, + gyro_awake_durn_u8); + com_rslt += + p_bno055->BNO055_BUS_WRITE_FUNC + (p_bno055->dev_addr, + BNO055_GYRO_AWAKE_DURN_REG, + &data_u8r, + BNO055_GEN_READ_WRITE_LENGTH); + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } else { + com_rslt = BNO055_ERROR; + } + } + if (prev_opmode_u8 != BNO055_OPERATION_MODE_CONFIG) + /* set the operation mode + of previous operation mode*/ + com_rslt += bno055_set_operation_mode + (prev_opmode_u8); + return com_rslt; +} \ No newline at end of file