pca95x4.c

Go to the documentation of this file.

/*
 * Copyright (C) 2020 Gautier Hattenberger <gautier.hattenberger@enac.fr>
 *
 * This file is part of paparazzi.
 *
 * paparazzi 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 2, or (at your option)
 * any later version.
 *
 * paparazzi 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 paparazzi; see the file COPYING.  If not, see
 * <http://www.gnu.org/licenses/>.
 */

#include "peripherals/pca95x4.h"

// Init function
void pca95x4_init(struct pca95x4 *dev, struct i2c_periph *i2c_p, uint8_t addr)
{
  /* set i2c_peripheral */
  dev->i2c_p = i2c_p;

  /* slave address */
  dev->i2c_trans.slave_addr = addr;
  /* set initial status: Done */
  dev->i2c_trans.status = I2CTransDone;
}

// Configure function
bool pca95x4_configure(struct pca95x4 *dev, uint8_t val, bool blocking)
{
  if (dev->i2c_trans.status != I2CTransDone &&
      dev->i2c_trans.status != I2CTransSuccess &&
      dev->i2c_trans.status != I2CTransFailed) {
    return false; // previous transaction not finished
  }
  // send config value
  dev->i2c_trans.buf[0] = PCA95X4_CONFIG_REG;
  dev->i2c_trans.buf[1] = val;
  if (blocking) {
    return i2c_blocking_transmit(dev->i2c_p, &dev->i2c_trans, dev->i2c_trans.slave_addr, 2);
  } else {
    return i2c_transmit(dev->i2c_p, &dev->i2c_trans, dev->i2c_trans.slave_addr, 2);
  }
}

// Set output function
bool pca95x4_set_output(struct pca95x4 *dev, uint8_t mask, bool blocking)
{
  if (dev->i2c_trans.status != I2CTransDone &&
      dev->i2c_trans.status != I2CTransSuccess &&
      dev->i2c_trans.status != I2CTransFailed) {
    return false; // previous transaction not finished
  }
  // send mask value
  dev->i2c_trans.buf[0] = PCA95X4_OUTPUT_REG;
  dev->i2c_trans.buf[1] = mask;
  if (blocking) {
    return i2c_blocking_transmit(dev->i2c_p, &dev->i2c_trans, dev->i2c_trans.slave_addr, 2);
  } else {
    return i2c_transmit(dev->i2c_p, &dev->i2c_trans, dev->i2c_trans.slave_addr, 2);
  }
}