aboutsummaryrefslogtreecommitdiffstats
path: root/ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c
diff options
context:
space:
mode:
Diffstat (limited to 'ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c')
-rw-r--r--ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c205
1 files changed, 0 insertions, 205 deletions
diff --git a/ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c b/ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c
deleted file mode 100644
index 070c49c..0000000
--- a/ChibiOS_16.1.5/community/os/various/devices_lib/mems/lsm303dlhc.c
+++ /dev/null
@@ -1,205 +0,0 @@
-/*
- Pretty LAYer for ChibiOS/RT - Copyright (C) 2015 Rocco Marco Guglielmi
-
- This file is part of PLAY for ChibiOS/RT.
-
- PLAY is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; either version 3 of the License, or
- (at your option) any later version.
-
- PLAY is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
-
- You should have received a copy of the GNU General Public License
- along with this program. If not, see <http://www.gnu.org/licenses/>.
-*/
-
-/*
- Special thanks to Giovanni Di Sirio for teachings, his moral support and
- friendship. Note that some or every piece of this file could be part of
- the ChibiOS project that is intellectual property of Giovanni Di Sirio.
- Please refer to ChibiOS/RT license before use this file.
-
- For suggestion or Bug report - roccomarco.guglielmi@playembedded.org
- */
-
-/**
- * @file lsm303dlhc.c
- * @brief LSM303DLHC MEMS interface module through I2C code.
- *
- * @addtogroup lsm303dlhc
- * @{
- */
-
-#include "ch.h"
-#include "hal.h"
-
-#include "lsm303dlhc.h"
-
-/*===========================================================================*/
-/* Driver local definitions. */
-/*===========================================================================*/
-
-/*===========================================================================*/
-/* Driver exported variables. */
-/*===========================================================================*/
-
-/*===========================================================================*/
-/* Driver local variables and types. */
-/*===========================================================================*/
-
-
-/*===========================================================================*/
-/* Driver local functions. */
-/*===========================================================================*/
-
-/*===========================================================================*/
-/* Driver exported functions. */
-/*===========================================================================*/
-
-/**
- * @brief Reads a generic sub-register value.
- * @pre The I2C interface must be initialized and the driver started.
- *
- * @param[in] i2cp pointer to the I2C interface
- * @param[in] sad slave address without R bit
- * @param[in] sub sub-register address
- * @param[in] message pointer to message
- * @return register value.
- */
-uint8_t lsm303dlhcReadRegister(I2CDriver *i2cp, uint8_t sad, uint8_t sub,
- msg_t* message) {
-
- uint8_t txbuf, rxbuf[2];
-#if defined(STM32F103_MCUCONF)
- txbuf = LSM303DLHC_SUB_MSB | sub;
- if(message != NULL){
- *message = i2cMasterTransmitTimeout(i2cp, sad, &txbuf, 1, rxbuf, 2,
- TIME_INFINITE);
- }
- else{
- i2cMasterTransmitTimeout(i2cp, sad, &txbuf, 1, rxbuf, 2, TIME_INFINITE);
- }
- return rxbuf[0];
-#else
- txbuf = sub;
- if(message != NULL){
- *message = i2cMasterTransmitTimeout(i2cp, sad, &txbuf, 1, rxbuf, 1,
- TIME_INFINITE);
- }
- else{
- i2cMasterTransmitTimeout(i2cp, sad, &txbuf, 1, rxbuf, 1, TIME_INFINITE);
- }
- return rxbuf[0];
-#endif
-
-
-}
-
-/**
- * @brief Writes a value into a register.
- * @pre The I2C interface must be initialized and the driver started.
- *
- * @param[in] i2cp pointer to the I2C interface
- * @param[in] sad slave address without R bit
- * @param[in] sub sub-register address
- * @param[in] value the value to be written
- * @param[out] message pointer to message
- */
-void lsm303dlhcWriteRegister(I2CDriver *i2cp,uint8_t sad, uint8_t sub,
- uint8_t value, msg_t* message) {
-
- uint8_t txbuf[2];
- uint8_t rxbuf;
- if(sad == LSM303DLHC_SAD_ACCEL){
- switch (sub) {
- default:
- /* Reserved register must not be written, according to the datasheet
- * this could permanently damage the device.
- */
- chDbgAssert(FALSE, "lsm303dlhcWriteRegister(), reserved register");
- case LSM303DLHC_SUB_ACC_STATUS_REG:
- case LSM303DLHC_SUB_ACC_OUT_X_L:
- case LSM303DLHC_SUB_ACC_OUT_X_H:
- case LSM303DLHC_SUB_ACC_OUT_Y_L:
- case LSM303DLHC_SUB_ACC_OUT_Y_H:
- case LSM303DLHC_SUB_ACC_OUT_Z_L:
- case LSM303DLHC_SUB_ACC_OUT_Z_H:
- case LSM303DLHC_SUB_ACC_FIFO_SRC_REG:
- case LSM303DLHC_SUB_ACC_INT1_SOURCE:
- case LSM303DLHC_SUB_ACC_INT2_SOURCE:
- case LSM303DLHC_SUB_ACC_CLICK_SRC:
- /* Read only registers cannot be written, the command is ignored.*/
- return;
- case LSM303DLHC_SUB_ACC_CTRL_REG1:
- case LSM303DLHC_SUB_ACC_CTRL_REG2:
- case LSM303DLHC_SUB_ACC_CTRL_REG3:
- case LSM303DLHC_SUB_ACC_CTRL_REG4:
- case LSM303DLHC_SUB_ACC_CTRL_REG5:
- case LSM303DLHC_SUB_ACC_CTRL_REG6:
- case LSM303DLHC_SUB_ACC_REFERENCE:
- case LSM303DLHC_SUB_ACC_FIFO_CTRL_REG:
- case LSM303DLHC_SUB_ACC_INT1_CFG:
- case LSM303DLHC_SUB_ACC_INT1_THS:
- case LSM303DLHC_SUB_ACC_INT1_DURATION:
- case LSM303DLHC_SUB_ACC_INT2_CFG:
- case LSM303DLHC_SUB_ACC_INT2_THS:
- case LSM303DLHC_SUB_ACC_INT2_DURATION:
- case LSM303DLHC_SUB_ACC_CLICK_CFG:
- case LSM303DLHC_SUB_ACC_CLICK_THS:
- case LSM303DLHC_SUB_ACC_TIME_LIMIT:
- case LSM303DLHC_SUB_ACC_TIME_LATENCY:
- case LSM303DLHC_SUB_ACC_TIME_WINDOW:
- txbuf[0] = sub;
- txbuf[1] = value;
- if(message != NULL){
- *message = i2cMasterTransmitTimeout(i2cp, sad, txbuf, 2, &rxbuf, 0,
- TIME_INFINITE);
- }
- else{
- i2cMasterTransmitTimeout(i2cp, sad, txbuf, 2, &rxbuf, 0, TIME_INFINITE);
- }
- break;
- }
- }
- else if(sad == LSM303DLHC_SAD_COMPASS){
- switch (sub) {
- default:
- /* Reserved register must not be written, according to the datasheet
- * this could permanently damage the device.
- */
- chDbgAssert(FALSE, "lsm303dlhcWriteRegister(), reserved register");
- case LSM303DLHC_SUB_COMP_OUT_X_H:
- case LSM303DLHC_SUB_COMP_OUT_X_L:
- case LSM303DLHC_SUB_COMP_OUT_Z_H:
- case LSM303DLHC_SUB_COMP_OUT_Z_L:
- case LSM303DLHC_SUB_COMP_OUT_Y_H:
- case LSM303DLHC_SUB_COMP_OUT_Y_L:
- case LSM303DLHC_SUB_COMP_SR_REG:
- case LSM303DLHC_SUB_COMP_IRA_REG:
- case LSM303DLHC_SUB_COMP_IRB_REG:
- case LSM303DLHC_SUB_COMP_IRC_REG:
- case LSM303DLHC_SUB_COMP_TEMP_OUT_H:
- case LSM303DLHC_SUB_COMP_TEMP_OUT_L:
- /* Read only registers cannot be written, the command is ignored.*/
- return;
- case LSM303DLHC_SUB_COMP_CRA_REG:
- case LSM303DLHC_SUB_COMP_CRB_REG:
- case LSM303DLHC_SUB_COMP_MR_REG:
- txbuf[0] = sub;
- txbuf[1] = value;
- if(message != NULL){
- *message = i2cMasterTransmitTimeout(i2cp, sad, txbuf, 2, &rxbuf, 0,
- TIME_INFINITE);
- }
- else{
- i2cMasterTransmitTimeout(i2cp, sad, txbuf, 2, &rxbuf, 0, TIME_INFINITE);
- }
- break;
- }
- }
-}
-/** @} */
generated by cgit v1.2.3 (git 2.39.1) at 2025-04-17 07:08:22 +0000