#include "ch.h"
#include "hal.h"

#include "i2c_pns.h"

#include "lis3.h"
#include "tmp75.h"
#include "max1236.h"

/* I2C1 */
static const I2CConfig i2cfg1 = {
    OPMODE_I2C,
    100000,
    STD_DUTY_CYCLE,
    0,
    0,
    0,
    0,
};

/* I2C2 */
static const I2CConfig i2cfg2 = {
    OPMODE_I2C,
    100000,
    STD_DUTY_CYCLE,
    0,
    0,
    0,
    0,
};



void I2CInit_pns(void){
  i2cInit();

  i2cStart(&I2CD1, &i2cfg1);
  i2cStart(&I2CD2, &i2cfg2);

  /* tune ports for I2C1*/
  palSetPadMode(IOPORT2, 6, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
  palSetPadMode(IOPORT2, 7, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);

  /* tune ports for I2C2*/
  palSetPadMode(IOPORT2, 10, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
  palSetPadMode(IOPORT2, 11, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);

  /* startups. Pauses added just to be safe */
  chThdSleepMilliseconds(1000);
  init_max1236();
  chThdSleepMilliseconds(1000);
  init_lis3();
  chThdSleepMilliseconds(1000);
}