1 files changed, 58 insertions, 0 deletions
diff --git a/testhal/STM32/I2C/i2c_pns.c b/testhal/STM32/I2C/i2c_pns.c
new file mode 100644
index 000000000..63f7d99bd
--- /dev/null
+++ b/testhal/STM32/I2C/i2c_pns.c
@@ -0,0 +1,58 @@
+#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 */
+  init_max1236();
+  chThdSleepMilliseconds(100);
+
+  init_lis3();
+  chThdSleepMilliseconds(100);
+}
+
+