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

amiro-lld / source / P9221R / v1 / alld_P9221R_v1.c @ 9797f02a

History | View | Annotate | Download (6.505 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
  */
-f02a
+apalExitStatus_t p9221r_lld_read_register(const P9221RDriver* const p9221r, const p9221r_lld_register_t addr, uint8_t* const data, const uint8_t num, const apalTime_t timeout)
-ef38c23
+            Julia Niermann
   apalDbgAssert(p9221r != NULL);
   apalDbgAssert(p9221r->i2cd != NULL);
   apalDbgAssert(data != NULL);
-f02a
+  uint8_t buffer[num];
   for (uint8_t i = 0; i < num; ++i) {
-c98f7
+      buffer[i] = 1;
+  }
-f02a
+  apalExitStatus_t status = apalI2CMasterTransmit(p9221r->i2cd, (P9221R_LLD_I2C_ADDR_FIXED | p9221r->addr), (uint8_t*)&addr, 1, buffer, num, timeout);
-ef38c23
+  for (uint8_t dataIdx = 0; dataIdx < num; dataIdx++) {
-f02a
+    //data[dataIdx] = (buffer[2*dataIdx] << 8) | buffer[2*dataIdx+1];
       data[dataIdx] = buffer[dataIdx];
    // TODO test!
-ef38c23
+            Julia Niermann
   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
-f02a
+/**
  * @brief Read the x_alignment.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[out]  x_alignment alignment register content
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
 apalExitStatus_t p9221r_lld_read_x_alignment(const P9221RDriver* const p9221r, int32_t const x_alignment, const apalTime_t timeout)
+{
     apalExitStatus_t status = NULL;
     return status;
+}
 /**
  * @brief Read the y_alignment.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[out]  y_alignment alignment register content
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
 apalExitStatus_t p9221r_lld_read_y_alignment(const P9221RDriver* const p9221r, int32_t const y_alignment, const apalTime_t timeout)
+{
     apalExitStatus_t status = NULL;
     return status;
+}
 /**
  * @brief Read the voltage.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[out]  voltage     voltage register content
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
 apalExitStatus_t p9221r_lld_read_voltage(const P9221RDriver* const p9221r, int32_t const voltage, const apalTime_t timeout)
+{
     apalExitStatus_t status = NULL;
     return status;
+}
 /**
  * @brief Read the current.
  * @param[in]   i2cd        i2c driver
  * @param[in]   PRd         p9221r driver
  * @param[out]  current     register content
  * @param[in]   timeout     timeout
  * @return                  An indicator whether the call was successfull
  */
 apalExitStatus_t p9221r_lld_read_current(const P9221RDriver* const p9221r, int32_t const current, const apalTime_t timeout)
+{
     apalExitStatus_t status = NULL;
     return status;
+}
-dbb62d
+#endif /* defined(AMIROLLD_CFG_P9221R) && (AMIROLLD_CFG_P9221R == 1) */
-ef38c23
+            Julia Niermann