src/main/drivers/bus_i2c_busdev.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <stdbool.h>
  22 #include <stdint.h>
  23 #include <string.h>
  24
  25 #include "platform.h"
  26
  27 #if defined(USE_I2C)
  28
  29 #include "drivers/bus.h"
  30 #include "drivers/bus_i2c.h"
  31
  32 static uint8_t i2cRegisteredDeviceCount = 0;
  33
  34 bool i2cBusWriteRegister(const extDevice_t *dev, uint8_t reg, uint8_t data)
  35 {
  36     return i2cWrite(dev->bus->busType_u.i2c.device, dev->busType_u.i2c.address, reg, data);
  37 }
  38
  39 bool i2cBusWriteRegisterStart(const extDevice_t *dev, uint8_t reg, uint8_t data)
  40 {
  41     // Need a static value, not on the stack
  42     static uint8_t byte;
  43
  44     byte = data;
  45
  46     return i2cWriteBuffer(dev->bus->busType_u.i2c.device, dev->busType_u.i2c.address, reg, sizeof(byte), &byte);
  47 }
  48
  49 bool i2cBusReadRegisterBuffer(const extDevice_t *dev, uint8_t reg, uint8_t *data, uint8_t length)
  50 {
  51     return i2cRead(dev->bus->busType_u.i2c.device, dev->busType_u.i2c.address, reg, length, data);
  52 }
  53
  54 uint8_t i2cBusReadRegister(const extDevice_t *dev, uint8_t reg)
  55 {
  56     uint8_t data;
  57     i2cRead(dev->bus->busType_u.i2c.device, dev->busType_u.i2c.address, reg, 1, &data);
  58     return data;
  59 }
  60
  61 bool i2cBusReadRegisterBufferStart(const extDevice_t *dev, uint8_t reg, uint8_t *data, uint8_t length)
  62 {
  63     return i2cReadBuffer(dev->bus->busType_u.i2c.device, dev->busType_u.i2c.address, reg, length, data);
  64 }
  65
  66 bool i2cBusBusy(const extDevice_t *dev, bool *error)
  67 {
  68     return i2cBusy(dev->bus->busType_u.i2c.device, error);
  69 }
  70
  71 bool i2cBusSetInstance(extDevice_t *dev, uint32_t device)
  72 {
  73     // I2C bus structures to associate with external devices
  74     static busDevice_t i2cBus[I2CDEV_COUNT];
  75
  76     if ((device < 1) || (device > I2CDEV_COUNT)) {
  77         return false;
  78     }
  79
  80     dev->bus = &i2cBus[I2C_CFG_TO_DEV(device)];
  81     dev->bus->busType = BUS_TYPE_I2C;
  82     dev->bus->busType_u.i2c.device = I2C_CFG_TO_DEV(device);
  83
  84     return true;
  85 }
  86
  87 void i2cBusDeviceRegister(const extDevice_t *dev)
  88 {
  89     UNUSED(dev);
  90
  91     i2cRegisteredDeviceCount++;
  92 }
  93
  94 uint8_t i2cGetRegisteredDeviceCount(void)
  95 {
  96     return i2cRegisteredDeviceCount;
  97 }
  98 #endif