/source/P9221R/v1/alld_P9221R_v1.c - Annotate - AMiRo-OS - Research for Cognitive Interaction

amiro-lld / source / P9221R / v1 / alld_P9221R_v1.c @ 067c98f7

History | View | Annotate | Download (4.683 KB)

-ef38c23
+/*
 AMiRo-LLD is a compilation of low-level hardware drivers for the Autonomous Mini Robot (AMiRo) platform.
 Copyright (C) 2016..2019  Thomas Schöpping et al.
 This program is free software: you can redistribute it and/or modify
 it under the terms of the GNU Lesser General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.
 This program 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 Lesser General Public License for more details.
 You should have received a copy of the GNU Lesser General Public License
 along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
 /**
  * @file    alld_P9221R_v1.c
+ *
  * @brief   Power Monitor function implementations
+ *
  * @addtogroup lld_power
  * @{
  */
-dbb62d
+#include <alld_P9221R.h>
-ef38c23
+            Julia Niermann
-dbb62d
+#if (defined(AMIROLLD_CFG_P9221R) && (AMIROLLD_CFG_P9221R == 1)) || defined(__DOXYGEN__)
-ef38c23
+            Julia Niermann
 /******************************************************************************/
 /* LOCAL DEFINITIONS                                                          */
 /******************************************************************************/
 /******************************************************************************/
 /* EXPORTED VARIABLES                                                         */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL TYPES                                                                */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL VARIABLES                                                            */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL FUNCTIONS                                                            */
 /******************************************************************************/
 /******************************************************************************/
 /* EXPORTED FUNCTIONS                                                         */
 /******************************************************************************/
 /**
  * @brief Read the value of one or more of the registers.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[in]   addr        register address
  * @param[out]  data        register content
  * @param[in]   num         number of subsequent registers to read
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
 apalExitStatus_t p9221r_lld_read_register(const P9221RDriver* const p9221r, const p9221r_lld_register_t addr, uint16_t* const data, const uint8_t num, const apalTime_t timeout)
+{
   apalDbgAssert(p9221r != NULL);
   apalDbgAssert(p9221r->i2cd != NULL);
   apalDbgAssert(data != NULL);
-c98f7
+  uint16_t address = ((uint16_t)addr << 8) | ((uint16_t)addr & 0x00FF);
-ef38c23
+  uint8_t buffer[num*2];
-c98f7
+  for (uint8_t i = 0; i < num*2; ++i) {
       buffer[i] = 1;
+  }
   apalExitStatus_t status = apalI2CMasterTransmit(p9221r->i2cd, (P9221R_LLD_I2C_ADDR_FIXED | p9221r->addr), &address, 2, buffer, 2*num, timeout);
-ef38c23
+  for (uint8_t dataIdx = 0; dataIdx < num; dataIdx++) {
     data[dataIdx] = (buffer[2*dataIdx] << 8) | buffer[2*dataIdx+1];
+  }
   return status;
+}
 /**
  * @brief Write the value of one or more of the registers.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[in]   addr        register address
  * @param[in]   data        data to write
  * @param[in]   num         number of subsequent registers to read
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
-a771
+apalExitStatus_t p9221r_lld_write_register(const P9221RDriver* const p9221r, const p9221r_lld_register_t addr, const uint16_t* const data, const uint8_t num, const apalTime_t timeout)
-ef38c23
+            Julia Niermann
   apalDbgAssert(p9221r != NULL);
   apalDbgAssert(p9221r->i2cd != NULL);
   apalDbgAssert(data != NULL);
   uint8_t buffer[1+2*num];
   buffer[0] = addr;
   for (uint8_t dataIdx = 0; dataIdx < num; dataIdx++) {
     buffer[dataIdx*2+1] = data[dataIdx] >> 8;
     buffer[dataIdx*2+2] = data[dataIdx] & (0x00FFu);
+  }
-a771
+  return apalI2CMasterTransmit(p9221r->i2cd, (P9221R_LLD_I2C_ADDR_FIXED | p9221r->addr), buffer, 1+2*num, NULL, 0, timeout);
-ef38c23
+            Julia Niermann
-dbb62d
+#endif /* defined(AMIROLLD_CFG_P9221R) && (AMIROLLD_CFG_P9221R == 1) */
-ef38c23
+            Julia Niermann