add i2c support

[protos/imu.git] / main.c

diff --git a/main.c b/main.c
index 9b801f5..8502044 100644 (file)
--- a/main.c
+++ b/main.c
@@ -51,10 +51,13 @@
 #include <rdline.h>
 #include <timer.h>
 #include <i2cm_sw.h>
+#include <i2c.h>
 
 #include "eeprom_config.h"
 #include "gps_venus.h"
 #include "sd_log.h"
+#include "../fpv-common/i2c_commands.h"
+#include "i2c_protocol.h"
 #include "main.h"
 
 struct imuboard imuboard;
@@ -164,6 +167,12 @@ int main(void)
        /* communication with mpu6050 */
        i2cm_init();
 
+       /* i2c hw with mainboard */
+       i2c_init(I2C_MODE_SLAVE, I2C_IMUBOARD_ADDR);
+       i2c_protocol_init();
+       i2c_register_recv_event(i2c_recvevent);
+       i2c_register_send_event(i2c_sendevent);
+
        sei();
 
        eeprom_load_config();